David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 1 | /* head.S: Initial boot code for the Sparc64 port of Linux. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * |
David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 3 | * Copyright (C) 1996, 1997, 2007 David S. Miller (davem@davemloft.net) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * Copyright (C) 1996 David Sitsky (David.Sitsky@anu.edu.au) |
David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 5 | * Copyright (C) 1997, 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | * Copyright (C) 1997 Miguel de Icaza (miguel@nuclecu.unam.mx) |
| 7 | */ |
| 8 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 9 | #include <linux/version.h> |
| 10 | #include <linux/errno.h> |
David S. Miller | 951bc82 | 2006-05-31 01:24:02 -0700 | [diff] [blame] | 11 | #include <linux/threads.h> |
David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 12 | #include <linux/init.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include <asm/thread_info.h> |
| 14 | #include <asm/asi.h> |
| 15 | #include <asm/pstate.h> |
| 16 | #include <asm/ptrace.h> |
| 17 | #include <asm/spitfire.h> |
| 18 | #include <asm/page.h> |
| 19 | #include <asm/pgtable.h> |
| 20 | #include <asm/errno.h> |
| 21 | #include <asm/signal.h> |
| 22 | #include <asm/processor.h> |
| 23 | #include <asm/lsu.h> |
| 24 | #include <asm/dcr.h> |
| 25 | #include <asm/dcu.h> |
| 26 | #include <asm/head.h> |
| 27 | #include <asm/ttable.h> |
| 28 | #include <asm/mmu.h> |
David S. Miller | 56fb4df | 2006-02-26 23:24:22 -0800 | [diff] [blame] | 29 | #include <asm/cpudata.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | |
| 31 | /* This section from from _start to sparc64_boot_end should fit into |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 32 | * 0x0000000000404000 to 0x0000000000408000. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | .text |
| 35 | .globl start, _start, stext, _stext |
| 36 | _start: |
| 37 | start: |
| 38 | _stext: |
| 39 | stext: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | ! 0x0000000000404000 |
| 41 | b sparc64_boot |
| 42 | flushw /* Flush register file. */ |
| 43 | |
| 44 | /* This stuff has to be in sync with SILO and other potential boot loaders |
| 45 | * Fields should be kept upward compatible and whenever any change is made, |
| 46 | * HdrS version should be incremented. |
| 47 | */ |
| 48 | .global root_flags, ram_flags, root_dev |
| 49 | .global sparc_ramdisk_image, sparc_ramdisk_size |
| 50 | .global sparc_ramdisk_image64 |
| 51 | |
| 52 | .ascii "HdrS" |
| 53 | .word LINUX_VERSION_CODE |
| 54 | |
| 55 | /* History: |
| 56 | * |
| 57 | * 0x0300 : Supports being located at other than 0x4000 |
| 58 | * 0x0202 : Supports kernel params string |
| 59 | * 0x0201 : Supports reboot_command |
| 60 | */ |
| 61 | .half 0x0301 /* HdrS version */ |
| 62 | |
| 63 | root_flags: |
| 64 | .half 1 |
| 65 | root_dev: |
| 66 | .half 0 |
| 67 | ram_flags: |
| 68 | .half 0 |
| 69 | sparc_ramdisk_image: |
| 70 | .word 0 |
| 71 | sparc_ramdisk_size: |
| 72 | .word 0 |
| 73 | .xword reboot_command |
| 74 | .xword bootstr_info |
| 75 | sparc_ramdisk_image64: |
| 76 | .xword 0 |
| 77 | .word _end |
| 78 | |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 79 | /* PROM cif handler code address is in %o4. */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 80 | sparc64_boot: |
David S. Miller | 15f1483 | 2006-12-11 21:06:55 -0800 | [diff] [blame] | 81 | mov %o4, %l7 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 82 | |
| 83 | /* We need to remap the kernel. Use position independant |
| 84 | * code to remap us to KERNBASE. |
| 85 | * |
| 86 | * SILO can invoke us with 32-bit address masking enabled, |
| 87 | * so make sure that's clear. |
| 88 | */ |
| 89 | rdpr %pstate, %g1 |
| 90 | andn %g1, PSTATE_AM, %g1 |
| 91 | wrpr %g1, 0x0, %pstate |
| 92 | ba,a,pt %xcc, 1f |
| 93 | |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 94 | .globl prom_finddev_name, prom_chosen_path, prom_root_node |
| 95 | .globl prom_getprop_name, prom_mmu_name, prom_peer_name |
| 96 | .globl prom_callmethod_name, prom_translate_name, prom_root_compatible |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 97 | .globl prom_map_name, prom_unmap_name, prom_mmu_ihandle_cache |
| 98 | .globl prom_boot_mapped_pc, prom_boot_mapping_mode |
| 99 | .globl prom_boot_mapping_phys_high, prom_boot_mapping_phys_low |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 100 | .globl is_sun4v |
| 101 | prom_peer_name: |
| 102 | .asciz "peer" |
| 103 | prom_compatible_name: |
| 104 | .asciz "compatible" |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 105 | prom_finddev_name: |
| 106 | .asciz "finddevice" |
| 107 | prom_chosen_path: |
| 108 | .asciz "/chosen" |
| 109 | prom_getprop_name: |
| 110 | .asciz "getprop" |
| 111 | prom_mmu_name: |
| 112 | .asciz "mmu" |
| 113 | prom_callmethod_name: |
| 114 | .asciz "call-method" |
| 115 | prom_translate_name: |
| 116 | .asciz "translate" |
| 117 | prom_map_name: |
| 118 | .asciz "map" |
| 119 | prom_unmap_name: |
| 120 | .asciz "unmap" |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 121 | prom_sun4v_name: |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 122 | .asciz "sun4v" |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 123 | .align 4 |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 124 | prom_root_compatible: |
| 125 | .skip 64 |
| 126 | prom_root_node: |
| 127 | .word 0 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 128 | prom_mmu_ihandle_cache: |
| 129 | .word 0 |
| 130 | prom_boot_mapped_pc: |
| 131 | .word 0 |
| 132 | prom_boot_mapping_mode: |
| 133 | .word 0 |
| 134 | .align 8 |
| 135 | prom_boot_mapping_phys_high: |
| 136 | .xword 0 |
| 137 | prom_boot_mapping_phys_low: |
| 138 | .xword 0 |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 139 | is_sun4v: |
| 140 | .word 0 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 141 | 1: |
| 142 | rd %pc, %l0 |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 143 | |
| 144 | mov (1b - prom_peer_name), %l1 |
| 145 | sub %l0, %l1, %l1 |
| 146 | mov 0, %l2 |
| 147 | |
| 148 | /* prom_root_node = prom_peer(0) */ |
| 149 | stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "peer" |
| 150 | mov 1, %l3 |
| 151 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 1 |
| 152 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1 |
| 153 | stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1, 0 |
| 154 | stx %g0, [%sp + 2047 + 128 + 0x20] ! ret1 |
| 155 | call %l7 |
| 156 | add %sp, (2047 + 128), %o0 ! argument array |
| 157 | |
| 158 | ldx [%sp + 2047 + 128 + 0x20], %l4 ! prom root node |
| 159 | mov (1b - prom_root_node), %l1 |
| 160 | sub %l0, %l1, %l1 |
| 161 | stw %l4, [%l1] |
| 162 | |
| 163 | mov (1b - prom_getprop_name), %l1 |
| 164 | mov (1b - prom_compatible_name), %l2 |
| 165 | mov (1b - prom_root_compatible), %l5 |
| 166 | sub %l0, %l1, %l1 |
| 167 | sub %l0, %l2, %l2 |
| 168 | sub %l0, %l5, %l5 |
| 169 | |
| 170 | /* prom_getproperty(prom_root_node, "compatible", |
| 171 | * &prom_root_compatible, 64) |
| 172 | */ |
| 173 | stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "getprop" |
| 174 | mov 4, %l3 |
| 175 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 4 |
| 176 | mov 1, %l3 |
| 177 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1 |
| 178 | stx %l4, [%sp + 2047 + 128 + 0x18] ! arg1, prom_root_node |
| 179 | stx %l2, [%sp + 2047 + 128 + 0x20] ! arg2, "compatible" |
| 180 | stx %l5, [%sp + 2047 + 128 + 0x28] ! arg3, &prom_root_compatible |
| 181 | mov 64, %l3 |
| 182 | stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4, size |
| 183 | stx %g0, [%sp + 2047 + 128 + 0x38] ! ret1 |
| 184 | call %l7 |
| 185 | add %sp, (2047 + 128), %o0 ! argument array |
| 186 | |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 187 | mov (1b - prom_finddev_name), %l1 |
| 188 | mov (1b - prom_chosen_path), %l2 |
| 189 | mov (1b - prom_boot_mapped_pc), %l3 |
| 190 | sub %l0, %l1, %l1 |
| 191 | sub %l0, %l2, %l2 |
| 192 | sub %l0, %l3, %l3 |
| 193 | stw %l0, [%l3] |
| 194 | sub %sp, (192 + 128), %sp |
| 195 | |
| 196 | /* chosen_node = prom_finddevice("/chosen") */ |
| 197 | stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "finddevice" |
| 198 | mov 1, %l3 |
| 199 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 1 |
| 200 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1 |
| 201 | stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1, "/chosen" |
| 202 | stx %g0, [%sp + 2047 + 128 + 0x20] ! ret1 |
| 203 | call %l7 |
| 204 | add %sp, (2047 + 128), %o0 ! argument array |
| 205 | |
| 206 | ldx [%sp + 2047 + 128 + 0x20], %l4 ! chosen device node |
| 207 | |
| 208 | mov (1b - prom_getprop_name), %l1 |
| 209 | mov (1b - prom_mmu_name), %l2 |
| 210 | mov (1b - prom_mmu_ihandle_cache), %l5 |
| 211 | sub %l0, %l1, %l1 |
| 212 | sub %l0, %l2, %l2 |
| 213 | sub %l0, %l5, %l5 |
| 214 | |
| 215 | /* prom_mmu_ihandle_cache = prom_getint(chosen_node, "mmu") */ |
| 216 | stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "getprop" |
| 217 | mov 4, %l3 |
| 218 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 4 |
| 219 | mov 1, %l3 |
| 220 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1 |
| 221 | stx %l4, [%sp + 2047 + 128 + 0x18] ! arg1, chosen_node |
| 222 | stx %l2, [%sp + 2047 + 128 + 0x20] ! arg2, "mmu" |
| 223 | stx %l5, [%sp + 2047 + 128 + 0x28] ! arg3, &prom_mmu_ihandle_cache |
| 224 | mov 4, %l3 |
| 225 | stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4, sizeof(arg3) |
| 226 | stx %g0, [%sp + 2047 + 128 + 0x38] ! ret1 |
| 227 | call %l7 |
| 228 | add %sp, (2047 + 128), %o0 ! argument array |
| 229 | |
| 230 | mov (1b - prom_callmethod_name), %l1 |
| 231 | mov (1b - prom_translate_name), %l2 |
| 232 | sub %l0, %l1, %l1 |
| 233 | sub %l0, %l2, %l2 |
| 234 | lduw [%l5], %l5 ! prom_mmu_ihandle_cache |
| 235 | |
| 236 | stx %l1, [%sp + 2047 + 128 + 0x00] ! service, "call-method" |
| 237 | mov 3, %l3 |
| 238 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 3 |
| 239 | mov 5, %l3 |
| 240 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 5 |
| 241 | stx %l2, [%sp + 2047 + 128 + 0x18] ! arg1: "translate" |
| 242 | stx %l5, [%sp + 2047 + 128 + 0x20] ! arg2: prom_mmu_ihandle_cache |
David S. Miller | b1b510a | 2005-10-11 15:45:16 -0700 | [diff] [blame] | 243 | /* PAGE align */ |
| 244 | srlx %l0, 13, %l3 |
| 245 | sllx %l3, 13, %l3 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 246 | stx %l3, [%sp + 2047 + 128 + 0x28] ! arg3: vaddr, our PC |
| 247 | stx %g0, [%sp + 2047 + 128 + 0x30] ! res1 |
| 248 | stx %g0, [%sp + 2047 + 128 + 0x38] ! res2 |
| 249 | stx %g0, [%sp + 2047 + 128 + 0x40] ! res3 |
| 250 | stx %g0, [%sp + 2047 + 128 + 0x48] ! res4 |
| 251 | stx %g0, [%sp + 2047 + 128 + 0x50] ! res5 |
| 252 | call %l7 |
| 253 | add %sp, (2047 + 128), %o0 ! argument array |
| 254 | |
| 255 | ldx [%sp + 2047 + 128 + 0x40], %l1 ! translation mode |
| 256 | mov (1b - prom_boot_mapping_mode), %l4 |
| 257 | sub %l0, %l4, %l4 |
| 258 | stw %l1, [%l4] |
| 259 | mov (1b - prom_boot_mapping_phys_high), %l4 |
| 260 | sub %l0, %l4, %l4 |
| 261 | ldx [%sp + 2047 + 128 + 0x48], %l2 ! physaddr high |
| 262 | stx %l2, [%l4 + 0x0] |
| 263 | ldx [%sp + 2047 + 128 + 0x50], %l3 ! physaddr low |
David S. Miller | b1b510a | 2005-10-11 15:45:16 -0700 | [diff] [blame] | 264 | /* 4MB align */ |
| 265 | srlx %l3, 22, %l3 |
| 266 | sllx %l3, 22, %l3 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 267 | stx %l3, [%l4 + 0x8] |
| 268 | |
| 269 | /* Leave service as-is, "call-method" */ |
| 270 | mov 7, %l3 |
| 271 | stx %l3, [%sp + 2047 + 128 + 0x08] ! num_args, 7 |
| 272 | mov 1, %l3 |
David S. Miller | a8201c6 | 2005-09-22 20:31:29 -0700 | [diff] [blame] | 273 | stx %l3, [%sp + 2047 + 128 + 0x10] ! num_rets, 1 |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 274 | mov (1b - prom_map_name), %l3 |
| 275 | sub %l0, %l3, %l3 |
| 276 | stx %l3, [%sp + 2047 + 128 + 0x18] ! arg1: "map" |
| 277 | /* Leave arg2 as-is, prom_mmu_ihandle_cache */ |
| 278 | mov -1, %l3 |
| 279 | stx %l3, [%sp + 2047 + 128 + 0x28] ! arg3: mode (-1 default) |
| 280 | sethi %hi(8 * 1024 * 1024), %l3 |
| 281 | stx %l3, [%sp + 2047 + 128 + 0x30] ! arg4: size (8MB) |
| 282 | sethi %hi(KERNBASE), %l3 |
| 283 | stx %l3, [%sp + 2047 + 128 + 0x38] ! arg5: vaddr (KERNBASE) |
| 284 | stx %g0, [%sp + 2047 + 128 + 0x40] ! arg6: empty |
| 285 | mov (1b - prom_boot_mapping_phys_low), %l3 |
| 286 | sub %l0, %l3, %l3 |
| 287 | ldx [%l3], %l3 |
| 288 | stx %l3, [%sp + 2047 + 128 + 0x48] ! arg7: phys addr |
| 289 | call %l7 |
| 290 | add %sp, (2047 + 128), %o0 ! argument array |
| 291 | |
| 292 | add %sp, (192 + 128), %sp |
| 293 | |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 294 | sethi %hi(prom_root_compatible), %g1 |
| 295 | or %g1, %lo(prom_root_compatible), %g1 |
| 296 | sethi %hi(prom_sun4v_name), %g7 |
| 297 | or %g7, %lo(prom_sun4v_name), %g7 |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 298 | mov 5, %g3 |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 299 | 1: ldub [%g7], %g2 |
| 300 | ldub [%g1], %g4 |
| 301 | cmp %g2, %g4 |
| 302 | bne,pn %icc, 2f |
| 303 | add %g7, 1, %g7 |
| 304 | subcc %g3, 1, %g3 |
| 305 | bne,pt %xcc, 1b |
| 306 | add %g1, 1, %g1 |
| 307 | |
| 308 | sethi %hi(is_sun4v), %g1 |
| 309 | or %g1, %lo(is_sun4v), %g1 |
| 310 | mov 1, %g7 |
| 311 | stw %g7, [%g1] |
| 312 | |
| 313 | 2: |
| 314 | BRANCH_IF_SUN4V(g1, jump_to_sun4u_init) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | BRANCH_IF_CHEETAH_BASE(g1,g7,cheetah_boot) |
| 316 | BRANCH_IF_CHEETAH_PLUS_OR_FOLLOWON(g1,g7,cheetah_plus_boot) |
| 317 | ba,pt %xcc, spitfire_boot |
| 318 | nop |
| 319 | |
| 320 | cheetah_plus_boot: |
| 321 | /* Preserve OBP chosen DCU and DCR register settings. */ |
| 322 | ba,pt %xcc, cheetah_generic_boot |
| 323 | nop |
| 324 | |
| 325 | cheetah_boot: |
| 326 | mov DCR_BPE | DCR_RPE | DCR_SI | DCR_IFPOE | DCR_MS, %g1 |
| 327 | wr %g1, %asr18 |
| 328 | |
| 329 | sethi %uhi(DCU_ME|DCU_RE|DCU_HPE|DCU_SPE|DCU_SL|DCU_WE), %g7 |
| 330 | or %g7, %ulo(DCU_ME|DCU_RE|DCU_HPE|DCU_SPE|DCU_SL|DCU_WE), %g7 |
| 331 | sllx %g7, 32, %g7 |
| 332 | or %g7, DCU_DM | DCU_IM | DCU_DC | DCU_IC, %g7 |
| 333 | stxa %g7, [%g0] ASI_DCU_CONTROL_REG |
| 334 | membar #Sync |
| 335 | |
| 336 | cheetah_generic_boot: |
| 337 | mov TSB_EXTENSION_P, %g3 |
| 338 | stxa %g0, [%g3] ASI_DMMU |
| 339 | stxa %g0, [%g3] ASI_IMMU |
| 340 | membar #Sync |
| 341 | |
| 342 | mov TSB_EXTENSION_S, %g3 |
| 343 | stxa %g0, [%g3] ASI_DMMU |
| 344 | membar #Sync |
| 345 | |
| 346 | mov TSB_EXTENSION_N, %g3 |
| 347 | stxa %g0, [%g3] ASI_DMMU |
| 348 | stxa %g0, [%g3] ASI_IMMU |
| 349 | membar #Sync |
| 350 | |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 351 | ba,a,pt %xcc, jump_to_sun4u_init |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | |
| 353 | spitfire_boot: |
| 354 | /* Typically PROM has already enabled both MMU's and both on-chip |
| 355 | * caches, but we do it here anyway just to be paranoid. |
| 356 | */ |
| 357 | mov (LSU_CONTROL_IC|LSU_CONTROL_DC|LSU_CONTROL_IM|LSU_CONTROL_DM), %g1 |
| 358 | stxa %g1, [%g0] ASI_LSU_CONTROL |
| 359 | membar #Sync |
| 360 | |
David S. Miller | bff06d5 | 2005-09-22 20:11:33 -0700 | [diff] [blame] | 361 | jump_to_sun4u_init: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | /* |
| 363 | * Make sure we are in privileged mode, have address masking, |
| 364 | * using the ordinary globals and have enabled floating |
| 365 | * point. |
| 366 | * |
| 367 | * Again, typically PROM has left %pil at 13 or similar, and |
| 368 | * (PSTATE_PRIV | PSTATE_PEF | PSTATE_IE) in %pstate. |
| 369 | */ |
| 370 | wrpr %g0, (PSTATE_PRIV|PSTATE_PEF|PSTATE_IE), %pstate |
| 371 | wr %g0, 0, %fprs |
| 372 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 373 | set sun4u_init, %g2 |
| 374 | jmpl %g2 + %g0, %g0 |
| 375 | nop |
| 376 | |
David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 377 | .section .text.init.refok |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 | sun4u_init: |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 379 | BRANCH_IF_SUN4V(g1, sun4v_init) |
| 380 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | /* Set ctx 0 */ |
David S. Miller | 8b11bd1 | 2006-02-07 22:13:05 -0800 | [diff] [blame] | 382 | mov PRIMARY_CONTEXT, %g7 |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 383 | stxa %g0, [%g7] ASI_DMMU |
David S. Miller | 8b11bd1 | 2006-02-07 22:13:05 -0800 | [diff] [blame] | 384 | membar #Sync |
| 385 | |
| 386 | mov SECONDARY_CONTEXT, %g7 |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 387 | stxa %g0, [%g7] ASI_DMMU |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 388 | membar #Sync |
| 389 | |
David S. Miller | 6cebb52 | 2006-02-11 10:56:43 -0800 | [diff] [blame] | 390 | ba,pt %xcc, sun4u_continue |
| 391 | nop |
| 392 | |
| 393 | sun4v_init: |
| 394 | /* Set ctx 0 */ |
| 395 | mov PRIMARY_CONTEXT, %g7 |
| 396 | stxa %g0, [%g7] ASI_MMU |
| 397 | membar #Sync |
| 398 | |
| 399 | mov SECONDARY_CONTEXT, %g7 |
| 400 | stxa %g0, [%g7] ASI_MMU |
| 401 | membar #Sync |
| 402 | ba,pt %xcc, niagara_tlb_fixup |
| 403 | nop |
| 404 | |
| 405 | sun4u_continue: |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 406 | BRANCH_IF_ANY_CHEETAH(g1, g7, cheetah_tlb_fixup) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 407 | |
| 408 | ba,pt %xcc, spitfire_tlb_fixup |
| 409 | nop |
| 410 | |
David S. Miller | 8591e30 | 2006-02-07 16:09:12 -0800 | [diff] [blame] | 411 | niagara_tlb_fixup: |
| 412 | mov 3, %g2 /* Set TLB type to hypervisor. */ |
| 413 | sethi %hi(tlb_type), %g1 |
| 414 | stw %g2, [%g1 + %lo(tlb_type)] |
| 415 | |
| 416 | /* Patch copy/clear ops. */ |
| 417 | call niagara_patch_copyops |
| 418 | nop |
David S. Miller | 8ca2557 | 2006-02-21 14:29:42 -0800 | [diff] [blame] | 419 | call niagara_patch_bzero |
| 420 | nop |
David S. Miller | 8591e30 | 2006-02-07 16:09:12 -0800 | [diff] [blame] | 421 | call niagara_patch_pageops |
| 422 | nop |
| 423 | |
| 424 | /* Patch TLB/cache ops. */ |
| 425 | call hypervisor_patch_cachetlbops |
| 426 | nop |
| 427 | |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 428 | ba,pt %xcc, tlb_fixup_done |
| 429 | nop |
| 430 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | cheetah_tlb_fixup: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 432 | mov 2, %g2 /* Set TLB type to cheetah+. */ |
| 433 | BRANCH_IF_CHEETAH_PLUS_OR_FOLLOWON(g1,g7,1f) |
| 434 | |
| 435 | mov 1, %g2 /* Set TLB type to cheetah. */ |
| 436 | |
| 437 | 1: sethi %hi(tlb_type), %g1 |
| 438 | stw %g2, [%g1 + %lo(tlb_type)] |
| 439 | |
David S. Miller | 0835ae0 | 2005-10-04 15:23:20 -0700 | [diff] [blame] | 440 | /* Patch copy/page operations to cheetah optimized versions. */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 441 | call cheetah_patch_copyops |
| 442 | nop |
David S. Miller | dbd2fdf | 2005-08-30 11:26:15 -0700 | [diff] [blame] | 443 | call cheetah_patch_copy_page |
| 444 | nop |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | call cheetah_patch_cachetlbops |
| 446 | nop |
| 447 | |
| 448 | ba,pt %xcc, tlb_fixup_done |
| 449 | nop |
| 450 | |
| 451 | spitfire_tlb_fixup: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | /* Set TLB type to spitfire. */ |
| 453 | mov 0, %g2 |
| 454 | sethi %hi(tlb_type), %g1 |
| 455 | stw %g2, [%g1 + %lo(tlb_type)] |
| 456 | |
| 457 | tlb_fixup_done: |
| 458 | sethi %hi(init_thread_union), %g6 |
| 459 | or %g6, %lo(init_thread_union), %g6 |
| 460 | ldx [%g6 + TI_TASK], %g4 |
| 461 | mov %sp, %l6 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 462 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 463 | wr %g0, ASI_P, %asi |
| 464 | mov 1, %g1 |
| 465 | sllx %g1, THREAD_SHIFT, %g1 |
| 466 | sub %g1, (STACKFRAME_SZ + STACK_BIAS), %g1 |
| 467 | add %g6, %g1, %sp |
| 468 | mov 0, %fp |
| 469 | |
| 470 | /* Set per-cpu pointer initially to zero, this makes |
| 471 | * the boot-cpu use the in-kernel-image per-cpu areas |
| 472 | * before setup_per_cpu_area() is invoked. |
| 473 | */ |
| 474 | clr %g5 |
| 475 | |
| 476 | wrpr %g0, 0, %wstate |
| 477 | wrpr %g0, 0x0, %tl |
| 478 | |
| 479 | /* Clear the bss */ |
| 480 | sethi %hi(__bss_start), %o0 |
| 481 | or %o0, %lo(__bss_start), %o0 |
| 482 | sethi %hi(_end), %o1 |
| 483 | or %o1, %lo(_end), %o1 |
| 484 | call __bzero |
| 485 | sub %o1, %o0, %o1 |
| 486 | |
David S. Miller | 10e2672 | 2006-11-16 13:38:57 -0800 | [diff] [blame] | 487 | #ifdef CONFIG_LOCKDEP |
| 488 | /* We have this call this super early, as even prom_init can grab |
| 489 | * spinlocks and thus call into the lockdep code. |
| 490 | */ |
| 491 | call lockdep_init |
| 492 | nop |
| 493 | #endif |
| 494 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 495 | mov %l6, %o1 ! OpenPROM stack |
| 496 | call prom_init |
| 497 | mov %l7, %o0 ! OpenPROM cif handler |
| 498 | |
David S. Miller | 951bc82 | 2006-05-31 01:24:02 -0700 | [diff] [blame] | 499 | /* Initialize current_thread_info()->cpu as early as possible. |
| 500 | * In order to do that accurately we have to patch up the get_cpuid() |
| 501 | * assembler sequences. And that, in turn, requires that we know |
| 502 | * if we are on a Starfire box or not. While we're here, patch up |
| 503 | * the sun4v sequences as well. |
| 504 | */ |
| 505 | call check_if_starfire |
| 506 | nop |
| 507 | call per_cpu_patch |
| 508 | nop |
| 509 | call sun4v_patch |
| 510 | nop |
| 511 | |
| 512 | #ifdef CONFIG_SMP |
| 513 | call hard_smp_processor_id |
| 514 | nop |
| 515 | cmp %o0, NR_CPUS |
| 516 | blu,pt %xcc, 1f |
| 517 | nop |
| 518 | call boot_cpu_id_too_large |
| 519 | nop |
| 520 | /* Not reached... */ |
| 521 | |
| 522 | 1: |
| 523 | #else |
| 524 | mov 0, %o0 |
| 525 | #endif |
David S. Miller | 22adb35 | 2007-05-26 01:14:43 -0700 | [diff] [blame] | 526 | sth %o0, [%g6 + TI_CPU] |
David S. Miller | 951bc82 | 2006-05-31 01:24:02 -0700 | [diff] [blame] | 527 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 528 | /* Off we go.... */ |
| 529 | call start_kernel |
| 530 | nop |
| 531 | /* Not reached... */ |
| 532 | |
David S. Miller | 1966287 | 2007-07-24 15:17:33 -0700 | [diff] [blame] | 533 | .previous |
| 534 | |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 535 | /* This is meant to allow the sharing of this code between |
| 536 | * boot processor invocation (via setup_tba() below) and |
| 537 | * secondary processor startup (via trampoline.S). The |
| 538 | * former does use this code, the latter does not yet due |
| 539 | * to some complexities. That should be fixed up at some |
| 540 | * point. |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 541 | * |
| 542 | * There used to be enormous complexity wrt. transferring |
| 543 | * over from the firwmare's trap table to the Linux kernel's. |
| 544 | * For example, there was a chicken & egg problem wrt. building |
| 545 | * the OBP page tables, yet needing to be on the Linux kernel |
| 546 | * trap table (to translate PAGE_OFFSET addresses) in order to |
| 547 | * do that. |
| 548 | * |
| 549 | * We now handle OBP tlb misses differently, via linear lookups |
| 550 | * into the prom_trans[] array. So that specific problem no |
| 551 | * longer exists. Yet, unfortunately there are still some issues |
| 552 | * preventing trampoline.S from using this code... ho hum. |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 553 | */ |
| 554 | .globl setup_trap_table |
| 555 | setup_trap_table: |
| 556 | save %sp, -192, %sp |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 558 | /* Force interrupts to be disabled. */ |
David S. Miller | d8573e2 | 2006-07-13 16:05:26 -0700 | [diff] [blame] | 559 | rdpr %pstate, %l0 |
| 560 | andn %l0, PSTATE_IE, %o1 |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 561 | wrpr %o1, 0x0, %pstate |
David S. Miller | d8573e2 | 2006-07-13 16:05:26 -0700 | [diff] [blame] | 562 | rdpr %pil, %l1 |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 563 | wrpr %g0, 15, %pil |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 564 | |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 565 | /* Make the firmware call to jump over to the Linux trap table. */ |
David S. Miller | 12eaa32 | 2006-02-10 15:39:51 -0800 | [diff] [blame] | 566 | sethi %hi(is_sun4v), %o0 |
| 567 | lduw [%o0 + %lo(is_sun4v)], %o0 |
| 568 | brz,pt %o0, 1f |
| 569 | nop |
| 570 | |
| 571 | TRAP_LOAD_TRAP_BLOCK(%g2, %g3) |
| 572 | add %g2, TRAP_PER_CPU_FAULT_INFO, %g2 |
| 573 | stxa %g2, [%g0] ASI_SCRATCHPAD |
| 574 | |
| 575 | /* Compute physical address: |
| 576 | * |
| 577 | * paddr = kern_base + (mmfsa_vaddr - KERNBASE) |
| 578 | */ |
| 579 | sethi %hi(KERNBASE), %g3 |
| 580 | sub %g2, %g3, %g2 |
| 581 | sethi %hi(kern_base), %g3 |
| 582 | ldx [%g3 + %lo(kern_base)], %g3 |
| 583 | add %g2, %g3, %o1 |
| 584 | |
| 585 | call prom_set_trap_table_sun4v |
| 586 | sethi %hi(sparc64_ttable_tl0), %o0 |
| 587 | |
| 588 | ba,pt %xcc, 2f |
| 589 | nop |
| 590 | |
| 591 | 1: call prom_set_trap_table |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 592 | sethi %hi(sparc64_ttable_tl0), %o0 |
| 593 | |
| 594 | /* Start using proper page size encodings in ctx register. */ |
David S. Miller | 12eaa32 | 2006-02-10 15:39:51 -0800 | [diff] [blame] | 595 | 2: sethi %hi(sparc64_kern_pri_context), %g3 |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 596 | ldx [%g3 + %lo(sparc64_kern_pri_context)], %g2 |
David S. Miller | 8b11bd1 | 2006-02-07 22:13:05 -0800 | [diff] [blame] | 597 | |
| 598 | mov PRIMARY_CONTEXT, %g1 |
| 599 | |
| 600 | 661: stxa %g2, [%g1] ASI_DMMU |
| 601 | .section .sun4v_1insn_patch, "ax" |
| 602 | .word 661b |
| 603 | stxa %g2, [%g1] ASI_MMU |
| 604 | .previous |
| 605 | |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 606 | membar #Sync |
| 607 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 608 | /* Kill PROM timer */ |
| 609 | sethi %hi(0x80000000), %o2 |
| 610 | sllx %o2, 32, %o2 |
| 611 | wr %o2, 0, %tick_cmpr |
| 612 | |
David S. Miller | d82ace7 | 2006-02-09 02:52:44 -0800 | [diff] [blame] | 613 | BRANCH_IF_SUN4V(o2, 1f) |
| 614 | BRANCH_IF_ANY_CHEETAH(o2, o3, 1f) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 615 | |
| 616 | ba,pt %xcc, 2f |
| 617 | nop |
| 618 | |
| 619 | /* Disable STICK_INT interrupts. */ |
| 620 | 1: |
| 621 | sethi %hi(0x80000000), %o2 |
| 622 | sllx %o2, 32, %o2 |
| 623 | wr %o2, %asr25 |
| 624 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 625 | 2: |
| 626 | wrpr %g0, %g0, %wstate |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 627 | |
| 628 | call init_irqwork_curcpu |
| 629 | nop |
| 630 | |
David S. Miller | d8573e2 | 2006-07-13 16:05:26 -0700 | [diff] [blame] | 631 | /* Now we can restore interrupt state. */ |
| 632 | wrpr %l0, 0, %pstate |
| 633 | wrpr %l1, 0x0, %pil |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 634 | |
| 635 | ret |
| 636 | restore |
| 637 | |
| 638 | .globl setup_tba |
David S. Miller | a8b900d | 2006-01-31 18:33:37 -0800 | [diff] [blame] | 639 | setup_tba: |
David S. Miller | 5d8e1b1 | 2005-10-10 16:12:13 -0700 | [diff] [blame] | 640 | save %sp, -192, %sp |
| 641 | |
| 642 | /* The boot processor is the only cpu which invokes this |
| 643 | * routine, the other cpus set things up via trampoline.S. |
| 644 | * So save the OBP trap table address here. |
| 645 | */ |
| 646 | rdpr %tba, %g7 |
| 647 | sethi %hi(prom_tba), %o1 |
| 648 | or %o1, %lo(prom_tba), %o1 |
| 649 | stx %g7, [%o1] |
| 650 | |
| 651 | call setup_trap_table |
| 652 | nop |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 653 | |
| 654 | ret |
| 655 | restore |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 656 | sparc64_boot_end: |
| 657 | |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 658 | #include "etrap.S" |
| 659 | #include "rtrap.S" |
| 660 | #include "winfixup.S" |
| 661 | #include "entry.S" |
David S. Miller | 5b0c057 | 2006-02-08 02:53:50 -0800 | [diff] [blame] | 662 | #include "sun4v_tlb_miss.S" |
| 663 | #include "sun4v_ivec.S" |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 664 | #include "ktlb.S" |
| 665 | #include "tsb.S" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 666 | |
| 667 | /* |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 668 | * The following skip makes sure the trap table in ttable.S is aligned |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 669 | * on a 32K boundary as required by the v9 specs for TBA register. |
David S. Miller | 2f7ee7c | 2006-01-31 18:33:49 -0800 | [diff] [blame] | 670 | * |
| 671 | * We align to a 32K boundary, then we have the 32K kernel TSB, |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 672 | * the 64K kernel 4MB TSB, and then the 32K aligned trap table. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 673 | */ |
David S. Miller | c9c1083 | 2005-10-12 12:22:46 -0700 | [diff] [blame] | 674 | 1: |
| 675 | .skip 0x4000 + _start - 1b |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 676 | |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 677 | ! 0x0000000000408000 |
| 678 | |
David S. Miller | 2f7ee7c | 2006-01-31 18:33:49 -0800 | [diff] [blame] | 679 | .globl swapper_tsb |
| 680 | swapper_tsb: |
| 681 | .skip (32 * 1024) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 682 | |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 683 | .globl swapper_4m_tsb |
| 684 | swapper_4m_tsb: |
| 685 | .skip (64 * 1024) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 686 | |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 687 | ! 0x0000000000420000 |
| 688 | |
| 689 | /* Some care needs to be exercised if you try to move the |
| 690 | * location of the trap table relative to other things. For |
| 691 | * one thing there are br* instructions in some of the |
| 692 | * trap table entires which branch back to code in ktlb.S |
| 693 | * Those instructions can only handle a signed 16-bit |
| 694 | * displacement. |
| 695 | * |
| 696 | * There is a binutils bug (bugzilla #4558) which causes |
| 697 | * the relocation overflow checks for such instructions to |
| 698 | * not be done correctly. So bintuils will not notice the |
| 699 | * error and will instead write junk into the relocation and |
| 700 | * you'll have an unbootable kernel. |
| 701 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 702 | #include "ttable.S" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 | |
David S. Miller | 2d9e276 | 2007-05-29 01:58:31 -0700 | [diff] [blame] | 704 | ! 0x0000000000428000 |
| 705 | |
David S. Miller | 074d82c | 2006-02-23 02:28:25 -0800 | [diff] [blame] | 706 | #include "systbls.S" |
| 707 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 708 | .data |
| 709 | .align 8 |
| 710 | .globl prom_tba, tlb_type |
| 711 | prom_tba: .xword 0 |
| 712 | tlb_type: .word 0 /* Must NOT end up in BSS */ |
| 713 | .section ".fixup",#alloc,#execinstr |
David S. Miller | 5fd2975 | 2005-09-28 20:41:45 -0700 | [diff] [blame] | 714 | |
| 715 | .globl __ret_efault, __retl_efault |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | __ret_efault: |
| 717 | ret |
| 718 | restore %g0, -EFAULT, %o0 |
David S. Miller | 5fd2975 | 2005-09-28 20:41:45 -0700 | [diff] [blame] | 719 | __retl_efault: |
| 720 | retl |
| 721 | mov -EFAULT, %o0 |