1/* arch/sparc/kernel/entry.S: Sparc trap low-level entry points. 2 * 3 * Copyright (C) 1995, 2007 David S. Miller (davem@davemloft.net) 4 * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be) 5 * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx) 6 * Copyright (C) 1996-1999 Jakub Jelinek (jj@sunsite.mff.cuni.cz) 7 * Copyright (C) 1997 Anton Blanchard (anton@progsoc.uts.edu.au) 8 */ 9 10#include <linux/linkage.h> 11#include <linux/errno.h> 12 13#include <asm/head.h> 14#include <asm/asi.h> 15#include <asm/smp.h> 16#include <asm/contregs.h> 17#include <asm/ptrace.h> 18#include <asm/asm-offsets.h> 19#include <asm/psr.h> 20#include <asm/vaddrs.h> 21#include <asm/page.h> 22#include <asm/pgtable.h> 23#include <asm/winmacro.h> 24#include <asm/signal.h> 25#include <asm/obio.h> 26#include <asm/mxcc.h> 27#include <asm/thread_info.h> 28#include <asm/param.h> 29#include <asm/unistd.h> 30 31#include <asm/asmmacro.h> 32 33#define curptr g6 34 35/* These are just handy. */ 36#define _SV save %sp, -STACKFRAME_SZ, %sp 37#define _RS restore 38 39#define FLUSH_ALL_KERNEL_WINDOWS \ 40 _SV; _SV; _SV; _SV; _SV; _SV; _SV; \ 41 _RS; _RS; _RS; _RS; _RS; _RS; _RS; 42 43 .text 44 45#ifdef CONFIG_KGDB 46 .align 4 47 .globl arch_kgdb_breakpoint 48 .type arch_kgdb_breakpoint,#function 49arch_kgdb_breakpoint: 50 ta 0x7d 51 retl 52 nop 53 .size arch_kgdb_breakpoint,.-arch_kgdb_breakpoint 54#endif 55 56#if defined(CONFIG_BLK_DEV_FD) || defined(CONFIG_BLK_DEV_FD_MODULE) 57 .align 4 58 .globl floppy_hardint 59floppy_hardint: 60 /* 61 * This code cannot touch registers %l0 %l1 and %l2 62 * because SAVE_ALL depends on their values. It depends 63 * on %l3 also, but we regenerate it before a call. 64 * Other registers are: 65 * %l3 -- base address of fdc registers 66 * %l4 -- pdma_vaddr 67 * %l5 -- scratch for ld/st address 68 * %l6 -- pdma_size 69 * %l7 -- scratch [floppy byte, ld/st address, aux. data] 70 */ 71 72 /* Do we have work to do? */ 73 sethi %hi(doing_pdma), %l7 74 ld [%l7 + %lo(doing_pdma)], %l7 75 cmp %l7, 0 76 be floppy_dosoftint 77 nop 78 79 /* Load fdc register base */ 80 sethi %hi(fdc_status), %l3 81 ld [%l3 + %lo(fdc_status)], %l3 82 83 /* Setup register addresses */ 84 sethi %hi(pdma_vaddr), %l5 ! transfer buffer 85 ld [%l5 + %lo(pdma_vaddr)], %l4 86 sethi %hi(pdma_size), %l5 ! bytes to go 87 ld [%l5 + %lo(pdma_size)], %l6 88next_byte: 89 ldub [%l3], %l7 90 91 andcc %l7, 0x80, %g0 ! Does fifo still have data 92 bz floppy_fifo_emptied ! fifo has been emptied... 93 andcc %l7, 0x20, %g0 ! in non-dma mode still? 94 bz floppy_overrun ! nope, overrun 95 andcc %l7, 0x40, %g0 ! 0=write 1=read 96 bz floppy_write 97 sub %l6, 0x1, %l6 98 99 /* Ok, actually read this byte */ 100 ldub [%l3 + 1], %l7 101 orcc %g0, %l6, %g0 102 stb %l7, [%l4] 103 bne next_byte 104 add %l4, 0x1, %l4 105 106 b floppy_tdone 107 nop 108 109floppy_write: 110 /* Ok, actually write this byte */ 111 ldub [%l4], %l7 112 orcc %g0, %l6, %g0 113 stb %l7, [%l3 + 1] 114 bne next_byte 115 add %l4, 0x1, %l4 116 117 /* fall through... */ 118floppy_tdone: 119 sethi %hi(pdma_vaddr), %l5 120 st %l4, [%l5 + %lo(pdma_vaddr)] 121 sethi %hi(pdma_size), %l5 122 st %l6, [%l5 + %lo(pdma_size)] 123 /* Flip terminal count pin */ 124 set auxio_register, %l7 125 ld [%l7], %l7 126 127 ldub [%l7], %l5 128 129 or %l5, 0xc2, %l5 130 stb %l5, [%l7] 131 andn %l5, 0x02, %l5 132 1332: 134 /* Kill some time so the bits set */ 135 WRITE_PAUSE 136 WRITE_PAUSE 137 138 stb %l5, [%l7] 139 140 /* Prevent recursion */ 141 sethi %hi(doing_pdma), %l7 142 b floppy_dosoftint 143 st %g0, [%l7 + %lo(doing_pdma)] 144 145 /* We emptied the FIFO, but we haven't read everything 146 * as of yet. Store the current transfer address and 147 * bytes left to read so we can continue when the next 148 * fast IRQ comes in. 149 */ 150floppy_fifo_emptied: 151 sethi %hi(pdma_vaddr), %l5 152 st %l4, [%l5 + %lo(pdma_vaddr)] 153 sethi %hi(pdma_size), %l7 154 st %l6, [%l7 + %lo(pdma_size)] 155 156 /* Restore condition codes */ 157 wr %l0, 0x0, %psr 158 WRITE_PAUSE 159 160 jmp %l1 161 rett %l2 162 163floppy_overrun: 164 sethi %hi(pdma_vaddr), %l5 165 st %l4, [%l5 + %lo(pdma_vaddr)] 166 sethi %hi(pdma_size), %l5 167 st %l6, [%l5 + %lo(pdma_size)] 168 /* Prevent recursion */ 169 sethi %hi(doing_pdma), %l7 170 st %g0, [%l7 + %lo(doing_pdma)] 171 172 /* fall through... */ 173floppy_dosoftint: 174 rd %wim, %l3 175 SAVE_ALL 176 177 /* Set all IRQs off. */ 178 or %l0, PSR_PIL, %l4 179 wr %l4, 0x0, %psr 180 WRITE_PAUSE 181 wr %l4, PSR_ET, %psr 182 WRITE_PAUSE 183 184 mov 11, %o0 ! floppy irq level (unused anyway) 185 mov %g0, %o1 ! devid is not used in fast interrupts 186 call sparc_floppy_irq 187 add %sp, STACKFRAME_SZ, %o2 ! struct pt_regs *regs 188 189 RESTORE_ALL 190 191#endif /* (CONFIG_BLK_DEV_FD) */ 192 193 /* Bad trap handler */ 194 .globl bad_trap_handler 195bad_trap_handler: 196 SAVE_ALL 197 198 wr %l0, PSR_ET, %psr 199 WRITE_PAUSE 200 201 add %sp, STACKFRAME_SZ, %o0 ! pt_regs 202 call do_hw_interrupt 203 mov %l7, %o1 ! trap number 204 205 RESTORE_ALL 206 207/* For now all IRQ's not registered get sent here. handler_irq() will 208 * see if a routine is registered to handle this interrupt and if not 209 * it will say so on the console. 210 */ 211 212 .align 4 213 .globl real_irq_entry, patch_handler_irq 214real_irq_entry: 215 SAVE_ALL 216 217#ifdef CONFIG_SMP 218 .globl patchme_maybe_smp_msg 219 220 cmp %l7, 11 221patchme_maybe_smp_msg: 222 bgu maybe_smp4m_msg 223 nop 224#endif 225 226real_irq_continue: 227 or %l0, PSR_PIL, %g2 228 wr %g2, 0x0, %psr 229 WRITE_PAUSE 230 wr %g2, PSR_ET, %psr 231 WRITE_PAUSE 232 mov %l7, %o0 ! irq level 233patch_handler_irq: 234 call handler_irq 235 add %sp, STACKFRAME_SZ, %o1 ! pt_regs ptr 236 or %l0, PSR_PIL, %g2 ! restore PIL after handler_irq 237 wr %g2, PSR_ET, %psr ! keep ET up 238 WRITE_PAUSE 239 240 RESTORE_ALL 241 242#ifdef CONFIG_SMP 243 /* SMP per-cpu ticker interrupts are handled specially. */ 244smp4m_ticker: 245 bne real_irq_continue+4 246 or %l0, PSR_PIL, %g2 247 wr %g2, 0x0, %psr 248 WRITE_PAUSE 249 wr %g2, PSR_ET, %psr 250 WRITE_PAUSE 251 call smp4m_percpu_timer_interrupt 252 add %sp, STACKFRAME_SZ, %o0 253 wr %l0, PSR_ET, %psr 254 WRITE_PAUSE 255 RESTORE_ALL 256 257#define GET_PROCESSOR4M_ID(reg) \ 258 rd %tbr, %reg; \ 259 srl %reg, 12, %reg; \ 260 and %reg, 3, %reg; 261 262 /* Here is where we check for possible SMP IPI passed to us 263 * on some level other than 15 which is the NMI and only used 264 * for cross calls. That has a separate entry point below. 265 * 266 * IPIs are sent on Level 12, 13 and 14. See IRQ_IPI_*. 267 */ 268maybe_smp4m_msg: 269 GET_PROCESSOR4M_ID(o3) 270 sethi %hi(sun4m_irq_percpu), %l5 271 sll %o3, 2, %o3 272 or %l5, %lo(sun4m_irq_percpu), %o5 273 sethi %hi(0x70000000), %o2 ! Check all soft-IRQs 274 ld [%o5 + %o3], %o1 275 ld [%o1 + 0x00], %o3 ! sun4m_irq_percpu[cpu]->pending 276 andcc %o3, %o2, %g0 277 be,a smp4m_ticker 278 cmp %l7, 14 279 /* Soft-IRQ IPI */ 280 st %o2, [%o1 + 0x04] ! sun4m_irq_percpu[cpu]->clear=0x70000000 281 WRITE_PAUSE 282 ld [%o1 + 0x00], %g0 ! sun4m_irq_percpu[cpu]->pending 283 WRITE_PAUSE 284 or %l0, PSR_PIL, %l4 285 wr %l4, 0x0, %psr 286 WRITE_PAUSE 287 wr %l4, PSR_ET, %psr 288 WRITE_PAUSE 289 srl %o3, 28, %o2 ! shift for simpler checks below 290maybe_smp4m_msg_check_single: 291 andcc %o2, 0x1, %g0 292 beq,a maybe_smp4m_msg_check_mask 293 andcc %o2, 0x2, %g0 294 call smp_call_function_single_interrupt 295 nop 296 andcc %o2, 0x2, %g0 297maybe_smp4m_msg_check_mask: 298 beq,a maybe_smp4m_msg_check_resched 299 andcc %o2, 0x4, %g0 300 call smp_call_function_interrupt 301 nop 302 andcc %o2, 0x4, %g0 303maybe_smp4m_msg_check_resched: 304 /* rescheduling is done in RESTORE_ALL regardless, but incr stats */ 305 beq,a maybe_smp4m_msg_out 306 nop 307 call smp_resched_interrupt 308 nop 309maybe_smp4m_msg_out: 310 RESTORE_ALL 311 312 .align 4 313 .globl linux_trap_ipi15_sun4m 314linux_trap_ipi15_sun4m: 315 SAVE_ALL 316 sethi %hi(0x80000000), %o2 317 GET_PROCESSOR4M_ID(o0) 318 sethi %hi(sun4m_irq_percpu), %l5 319 or %l5, %lo(sun4m_irq_percpu), %o5 320 sll %o0, 2, %o0 321 ld [%o5 + %o0], %o5 322 ld [%o5 + 0x00], %o3 ! sun4m_irq_percpu[cpu]->pending 323 andcc %o3, %o2, %g0 324 be sun4m_nmi_error ! Must be an NMI async memory error 325 st %o2, [%o5 + 0x04] ! sun4m_irq_percpu[cpu]->clear=0x80000000 326 WRITE_PAUSE 327 ld [%o5 + 0x00], %g0 ! sun4m_irq_percpu[cpu]->pending 328 WRITE_PAUSE 329 or %l0, PSR_PIL, %l4 330 wr %l4, 0x0, %psr 331 WRITE_PAUSE 332 wr %l4, PSR_ET, %psr 333 WRITE_PAUSE 334 call smp4m_cross_call_irq 335 nop 336 b ret_trap_lockless_ipi 337 clr %l6 338 339 .globl smp4d_ticker 340 /* SMP per-cpu ticker interrupts are handled specially. */ 341smp4d_ticker: 342 SAVE_ALL 343 or %l0, PSR_PIL, %g2 344 sethi %hi(CC_ICLR), %o0 345 sethi %hi(1 << 14), %o1 346 or %o0, %lo(CC_ICLR), %o0 347 stha %o1, [%o0] ASI_M_MXCC /* Clear PIL 14 in MXCC's ICLR */ 348 wr %g2, 0x0, %psr 349 WRITE_PAUSE 350 wr %g2, PSR_ET, %psr 351 WRITE_PAUSE 352 call smp4d_percpu_timer_interrupt 353 add %sp, STACKFRAME_SZ, %o0 354 wr %l0, PSR_ET, %psr 355 WRITE_PAUSE 356 RESTORE_ALL 357 358 .align 4 359 .globl linux_trap_ipi15_sun4d 360linux_trap_ipi15_sun4d: 361 SAVE_ALL 362 sethi %hi(CC_BASE), %o4 363 sethi %hi(MXCC_ERR_ME|MXCC_ERR_PEW|MXCC_ERR_ASE|MXCC_ERR_PEE), %o2 364 or %o4, (CC_EREG - CC_BASE), %o0 365 ldda [%o0] ASI_M_MXCC, %o0 366 andcc %o0, %o2, %g0 367 bne 1f 368 sethi %hi(BB_STAT2), %o2 369 lduba [%o2] ASI_M_CTL, %o2 370 andcc %o2, BB_STAT2_MASK, %g0 371 bne 2f 372 or %o4, (CC_ICLR - CC_BASE), %o0 373 sethi %hi(1 << 15), %o1 374 stha %o1, [%o0] ASI_M_MXCC /* Clear PIL 15 in MXCC's ICLR */ 375 or %l0, PSR_PIL, %l4 376 wr %l4, 0x0, %psr 377 WRITE_PAUSE 378 wr %l4, PSR_ET, %psr 379 WRITE_PAUSE 380 call smp4d_cross_call_irq 381 nop 382 b ret_trap_lockless_ipi 383 clr %l6 384 3851: /* MXCC error */ 3862: /* BB error */ 387 /* Disable PIL 15 */ 388 set CC_IMSK, %l4 389 lduha [%l4] ASI_M_MXCC, %l5 390 sethi %hi(1 << 15), %l7 391 or %l5, %l7, %l5 392 stha %l5, [%l4] ASI_M_MXCC 393 /* FIXME */ 3941: b,a 1b 395 396 .globl smpleon_ipi 397 .extern leon_ipi_interrupt 398 /* SMP per-cpu IPI interrupts are handled specially. */ 399smpleon_ipi: 400 SAVE_ALL 401 or %l0, PSR_PIL, %g2 402 wr %g2, 0x0, %psr 403 WRITE_PAUSE 404 wr %g2, PSR_ET, %psr 405 WRITE_PAUSE 406 call leonsmp_ipi_interrupt 407 add %sp, STACKFRAME_SZ, %o1 ! pt_regs 408 wr %l0, PSR_ET, %psr 409 WRITE_PAUSE 410 RESTORE_ALL 411 412 .align 4 413 .globl linux_trap_ipi15_leon 414linux_trap_ipi15_leon: 415 SAVE_ALL 416 or %l0, PSR_PIL, %l4 417 wr %l4, 0x0, %psr 418 WRITE_PAUSE 419 wr %l4, PSR_ET, %psr 420 WRITE_PAUSE 421 call leon_cross_call_irq 422 nop 423 b ret_trap_lockless_ipi 424 clr %l6 425 426#endif /* CONFIG_SMP */ 427 428 /* This routine handles illegal instructions and privileged 429 * instruction attempts from user code. 430 */ 431 .align 4 432 .globl bad_instruction 433bad_instruction: 434 sethi %hi(0xc1f80000), %l4 435 ld [%l1], %l5 436 sethi %hi(0x81d80000), %l7 437 and %l5, %l4, %l5 438 cmp %l5, %l7 439 be 1f 440 SAVE_ALL 441 442 wr %l0, PSR_ET, %psr ! re-enable traps 443 WRITE_PAUSE 444 445 add %sp, STACKFRAME_SZ, %o0 446 mov %l1, %o1 447 mov %l2, %o2 448 call do_illegal_instruction 449 mov %l0, %o3 450 451 RESTORE_ALL 452 4531: /* unimplemented flush - just skip */ 454 jmpl %l2, %g0 455 rett %l2 + 4 456 457 .align 4 458 .globl priv_instruction 459priv_instruction: 460 SAVE_ALL 461 462 wr %l0, PSR_ET, %psr 463 WRITE_PAUSE 464 465 add %sp, STACKFRAME_SZ, %o0 466 mov %l1, %o1 467 mov %l2, %o2 468 call do_priv_instruction 469 mov %l0, %o3 470 471 RESTORE_ALL 472 473 /* This routine handles unaligned data accesses. */ 474 .align 4 475 .globl mna_handler 476mna_handler: 477 andcc %l0, PSR_PS, %g0 478 be mna_fromuser 479 nop 480 481 SAVE_ALL 482 483 wr %l0, PSR_ET, %psr 484 WRITE_PAUSE 485 486 ld [%l1], %o1 487 call kernel_unaligned_trap 488 add %sp, STACKFRAME_SZ, %o0 489 490 RESTORE_ALL 491 492mna_fromuser: 493 SAVE_ALL 494 495 wr %l0, PSR_ET, %psr ! re-enable traps 496 WRITE_PAUSE 497 498 ld [%l1], %o1 499 call user_unaligned_trap 500 add %sp, STACKFRAME_SZ, %o0 501 502 RESTORE_ALL 503 504 /* This routine handles floating point disabled traps. */ 505 .align 4 506 .globl fpd_trap_handler 507fpd_trap_handler: 508 SAVE_ALL 509 510 wr %l0, PSR_ET, %psr ! re-enable traps 511 WRITE_PAUSE 512 513 add %sp, STACKFRAME_SZ, %o0 514 mov %l1, %o1 515 mov %l2, %o2 516 call do_fpd_trap 517 mov %l0, %o3 518 519 RESTORE_ALL 520 521 /* This routine handles Floating Point Exceptions. */ 522 .align 4 523 .globl fpe_trap_handler 524fpe_trap_handler: 525 set fpsave_magic, %l5 526 cmp %l1, %l5 527 be 1f 528 sethi %hi(fpsave), %l5 529 or %l5, %lo(fpsave), %l5 530 cmp %l1, %l5 531 bne 2f 532 sethi %hi(fpsave_catch2), %l5 533 or %l5, %lo(fpsave_catch2), %l5 534 wr %l0, 0x0, %psr 535 WRITE_PAUSE 536 jmp %l5 537 rett %l5 + 4 5381: 539 sethi %hi(fpsave_catch), %l5 540 or %l5, %lo(fpsave_catch), %l5 541 wr %l0, 0x0, %psr 542 WRITE_PAUSE 543 jmp %l5 544 rett %l5 + 4 545 5462: 547 SAVE_ALL 548 549 wr %l0, PSR_ET, %psr ! re-enable traps 550 WRITE_PAUSE 551 552 add %sp, STACKFRAME_SZ, %o0 553 mov %l1, %o1 554 mov %l2, %o2 555 call do_fpe_trap 556 mov %l0, %o3 557 558 RESTORE_ALL 559 560 /* This routine handles Tag Overflow Exceptions. */ 561 .align 4 562 .globl do_tag_overflow 563do_tag_overflow: 564 SAVE_ALL 565 566 wr %l0, PSR_ET, %psr ! re-enable traps 567 WRITE_PAUSE 568 569 add %sp, STACKFRAME_SZ, %o0 570 mov %l1, %o1 571 mov %l2, %o2 572 call handle_tag_overflow 573 mov %l0, %o3 574 575 RESTORE_ALL 576 577 /* This routine handles Watchpoint Exceptions. */ 578 .align 4 579 .globl do_watchpoint 580do_watchpoint: 581 SAVE_ALL 582 583 wr %l0, PSR_ET, %psr ! re-enable traps 584 WRITE_PAUSE 585 586 add %sp, STACKFRAME_SZ, %o0 587 mov %l1, %o1 588 mov %l2, %o2 589 call handle_watchpoint 590 mov %l0, %o3 591 592 RESTORE_ALL 593 594 /* This routine handles Register Access Exceptions. */ 595 .align 4 596 .globl do_reg_access 597do_reg_access: 598 SAVE_ALL 599 600 wr %l0, PSR_ET, %psr ! re-enable traps 601 WRITE_PAUSE 602 603 add %sp, STACKFRAME_SZ, %o0 604 mov %l1, %o1 605 mov %l2, %o2 606 call handle_reg_access 607 mov %l0, %o3 608 609 RESTORE_ALL 610 611 /* This routine handles Co-Processor Disabled Exceptions. */ 612 .align 4 613 .globl do_cp_disabled 614do_cp_disabled: 615 SAVE_ALL 616 617 wr %l0, PSR_ET, %psr ! re-enable traps 618 WRITE_PAUSE 619 620 add %sp, STACKFRAME_SZ, %o0 621 mov %l1, %o1 622 mov %l2, %o2 623 call handle_cp_disabled 624 mov %l0, %o3 625 626 RESTORE_ALL 627 628 /* This routine handles Co-Processor Exceptions. */ 629 .align 4 630 .globl do_cp_exception 631do_cp_exception: 632 SAVE_ALL 633 634 wr %l0, PSR_ET, %psr ! re-enable traps 635 WRITE_PAUSE 636 637 add %sp, STACKFRAME_SZ, %o0 638 mov %l1, %o1 639 mov %l2, %o2 640 call handle_cp_exception 641 mov %l0, %o3 642 643 RESTORE_ALL 644 645 /* This routine handles Hardware Divide By Zero Exceptions. */ 646 .align 4 647 .globl do_hw_divzero 648do_hw_divzero: 649 SAVE_ALL 650 651 wr %l0, PSR_ET, %psr ! re-enable traps 652 WRITE_PAUSE 653 654 add %sp, STACKFRAME_SZ, %o0 655 mov %l1, %o1 656 mov %l2, %o2 657 call handle_hw_divzero 658 mov %l0, %o3 659 660 RESTORE_ALL 661 662 .align 4 663 .globl do_flush_windows 664do_flush_windows: 665 SAVE_ALL 666 667 wr %l0, PSR_ET, %psr 668 WRITE_PAUSE 669 670 andcc %l0, PSR_PS, %g0 671 bne dfw_kernel 672 nop 673 674 call flush_user_windows 675 nop 676 677 /* Advance over the trap instruction. */ 678 ld [%sp + STACKFRAME_SZ + PT_NPC], %l1 679 add %l1, 0x4, %l2 680 st %l1, [%sp + STACKFRAME_SZ + PT_PC] 681 st %l2, [%sp + STACKFRAME_SZ + PT_NPC] 682 683 RESTORE_ALL 684 685 .globl flush_patch_one 686 687 /* We get these for debugging routines using __builtin_return_address() */ 688dfw_kernel: 689flush_patch_one: 690 FLUSH_ALL_KERNEL_WINDOWS 691 692 /* Advance over the trap instruction. */ 693 ld [%sp + STACKFRAME_SZ + PT_NPC], %l1 694 add %l1, 0x4, %l2 695 st %l1, [%sp + STACKFRAME_SZ + PT_PC] 696 st %l2, [%sp + STACKFRAME_SZ + PT_NPC] 697 698 RESTORE_ALL 699 700 /* The getcc software trap. The user wants the condition codes from 701 * the %psr in register %g1. 702 */ 703 704 .align 4 705 .globl getcc_trap_handler 706getcc_trap_handler: 707 srl %l0, 20, %g1 ! give user 708 and %g1, 0xf, %g1 ! only ICC bits in %psr 709 jmp %l2 ! advance over trap instruction 710 rett %l2 + 0x4 ! like this... 711 712 /* The setcc software trap. The user has condition codes in %g1 713 * that it would like placed in the %psr. Be careful not to flip 714 * any unintentional bits! 715 */ 716 717 .align 4 718 .globl setcc_trap_handler 719setcc_trap_handler: 720 sll %g1, 0x14, %l4 721 set PSR_ICC, %l5 722 andn %l0, %l5, %l0 ! clear ICC bits in %psr 723 and %l4, %l5, %l4 ! clear non-ICC bits in user value 724 or %l4, %l0, %l4 ! or them in... mix mix mix 725 726 wr %l4, 0x0, %psr ! set new %psr 727 WRITE_PAUSE ! TI scumbags... 728 729 jmp %l2 ! advance over trap instruction 730 rett %l2 + 0x4 ! like this... 731 732sun4m_nmi_error: 733 /* NMI async memory error handling. */ 734 sethi %hi(0x80000000), %l4 735 sethi %hi(sun4m_irq_global), %o5 736 ld [%o5 + %lo(sun4m_irq_global)], %l5 737 st %l4, [%l5 + 0x0c] ! sun4m_irq_global->mask_set=0x80000000 738 WRITE_PAUSE 739 ld [%l5 + 0x00], %g0 ! sun4m_irq_global->pending 740 WRITE_PAUSE 741 or %l0, PSR_PIL, %l4 742 wr %l4, 0x0, %psr 743 WRITE_PAUSE 744 wr %l4, PSR_ET, %psr 745 WRITE_PAUSE 746 call sun4m_nmi 747 nop 748 st %l4, [%l5 + 0x08] ! sun4m_irq_global->mask_clear=0x80000000 749 WRITE_PAUSE 750 ld [%l5 + 0x00], %g0 ! sun4m_irq_global->pending 751 WRITE_PAUSE 752 RESTORE_ALL 753 754#ifndef CONFIG_SMP 755 .align 4 756 .globl linux_trap_ipi15_sun4m 757linux_trap_ipi15_sun4m: 758 SAVE_ALL 759 760 ba sun4m_nmi_error 761 nop 762#endif /* CONFIG_SMP */ 763 764 .align 4 765 .globl srmmu_fault 766srmmu_fault: 767 mov 0x400, %l5 768 mov 0x300, %l4 769 770LEON_PI(lda [%l5] ASI_LEON_MMUREGS, %l6) ! read sfar first 771SUN_PI_(lda [%l5] ASI_M_MMUREGS, %l6) ! read sfar first 772 773LEON_PI(lda [%l4] ASI_LEON_MMUREGS, %l5) ! read sfsr last 774SUN_PI_(lda [%l4] ASI_M_MMUREGS, %l5) ! read sfsr last 775 776 andn %l6, 0xfff, %l6 777 srl %l5, 6, %l5 ! and encode all info into l7 778 779 and %l5, 2, %l5 780 or %l5, %l6, %l6 781 782 or %l6, %l7, %l7 ! l7 = [addr,write,txtfault] 783 784 SAVE_ALL 785 786 mov %l7, %o1 787 mov %l7, %o2 788 and %o1, 1, %o1 ! arg2 = text_faultp 789 mov %l7, %o3 790 and %o2, 2, %o2 ! arg3 = writep 791 andn %o3, 0xfff, %o3 ! arg4 = faulting address 792 793 wr %l0, PSR_ET, %psr 794 WRITE_PAUSE 795 796 call do_sparc_fault 797 add %sp, STACKFRAME_SZ, %o0 ! arg1 = pt_regs ptr 798 799 RESTORE_ALL 800 801 .align 4 802 .globl sys_nis_syscall 803sys_nis_syscall: 804 mov %o7, %l5 805 add %sp, STACKFRAME_SZ, %o0 ! pt_regs *regs arg 806 call c_sys_nis_syscall 807 mov %l5, %o7 808 809sunos_execv: 810 .globl sunos_execv 811 b sys_execve 812 clr %i2 813 814 .align 4 815 .globl sys_sparc_pipe 816sys_sparc_pipe: 817 mov %o7, %l5 818 add %sp, STACKFRAME_SZ, %o0 ! pt_regs *regs arg 819 call sparc_pipe 820 mov %l5, %o7 821 822 .align 4 823 .globl sys_sigstack 824sys_sigstack: 825 mov %o7, %l5 826 mov %fp, %o2 827 call do_sys_sigstack 828 mov %l5, %o7 829 830 .align 4 831 .globl sys_sigreturn 832sys_sigreturn: 833 call do_sigreturn 834 add %sp, STACKFRAME_SZ, %o0 835 836 ld [%curptr + TI_FLAGS], %l5 837 andcc %l5, _TIF_SYSCALL_TRACE, %g0 838 be 1f 839 nop 840 841 call syscall_trace 842 mov 1, %o1 843 8441: 845 /* We don't want to muck with user registers like a 846 * normal syscall, just return. 847 */ 848 RESTORE_ALL 849 850 .align 4 851 .globl sys_rt_sigreturn 852sys_rt_sigreturn: 853 call do_rt_sigreturn 854 add %sp, STACKFRAME_SZ, %o0 855 856 ld [%curptr + TI_FLAGS], %l5 857 andcc %l5, _TIF_SYSCALL_TRACE, %g0 858 be 1f 859 nop 860 861 add %sp, STACKFRAME_SZ, %o0 862 call syscall_trace 863 mov 1, %o1 864 8651: 866 /* We are returning to a signal handler. */ 867 RESTORE_ALL 868 869 /* Now that we have a real sys_clone, sys_fork() is 870 * implemented in terms of it. Our _real_ implementation 871 * of SunOS vfork() will use sys_vfork(). 872 * 873 * XXX These three should be consolidated into mostly shared 874 * XXX code just like on sparc64... -DaveM 875 */ 876 .align 4 877 .globl sys_fork, flush_patch_two 878sys_fork: 879 mov %o7, %l5 880flush_patch_two: 881 FLUSH_ALL_KERNEL_WINDOWS; 882 ld [%curptr + TI_TASK], %o4 883 rd %psr, %g4 884 WRITE_PAUSE 885 mov SIGCHLD, %o0 ! arg0: clone flags 886 rd %wim, %g5 887 WRITE_PAUSE 888 mov %fp, %o1 ! arg1: usp 889 std %g4, [%o4 + AOFF_task_thread + AOFF_thread_fork_kpsr] 890 add %sp, STACKFRAME_SZ, %o2 ! arg2: pt_regs ptr 891 mov 0, %o3 892 call sparc_do_fork 893 mov %l5, %o7 894 895 /* Whee, kernel threads! */ 896 .globl sys_clone, flush_patch_three 897sys_clone: 898 mov %o7, %l5 899flush_patch_three: 900 FLUSH_ALL_KERNEL_WINDOWS; 901 ld [%curptr + TI_TASK], %o4 902 rd %psr, %g4 903 WRITE_PAUSE 904 905 /* arg0,1: flags,usp -- loaded already */ 906 cmp %o1, 0x0 ! Is new_usp NULL? 907 rd %wim, %g5 908 WRITE_PAUSE 909 be,a 1f 910 mov %fp, %o1 ! yes, use callers usp 911 andn %o1, 7, %o1 ! no, align to 8 bytes 9121: 913 std %g4, [%o4 + AOFF_task_thread + AOFF_thread_fork_kpsr] 914 add %sp, STACKFRAME_SZ, %o2 ! arg2: pt_regs ptr 915 mov 0, %o3 916 call sparc_do_fork 917 mov %l5, %o7 918 919 /* Whee, real vfork! */ 920 .globl sys_vfork, flush_patch_four 921sys_vfork: 922flush_patch_four: 923 FLUSH_ALL_KERNEL_WINDOWS; 924 ld [%curptr + TI_TASK], %o4 925 rd %psr, %g4 926 WRITE_PAUSE 927 rd %wim, %g5 928 WRITE_PAUSE 929 std %g4, [%o4 + AOFF_task_thread + AOFF_thread_fork_kpsr] 930 sethi %hi(0x4000 | 0x0100 | SIGCHLD), %o0 931 mov %fp, %o1 932 or %o0, %lo(0x4000 | 0x0100 | SIGCHLD), %o0 933 sethi %hi(sparc_do_fork), %l1 934 mov 0, %o3 935 jmpl %l1 + %lo(sparc_do_fork), %g0 936 add %sp, STACKFRAME_SZ, %o2 937 938 .align 4 939linux_sparc_ni_syscall: 940 sethi %hi(sys_ni_syscall), %l7 941 b do_syscall 942 or %l7, %lo(sys_ni_syscall), %l7 943 944linux_syscall_trace: 945 add %sp, STACKFRAME_SZ, %o0 946 call syscall_trace 947 mov 0, %o1 948 cmp %o0, 0 949 bne 3f 950 mov -ENOSYS, %o0 951 952 /* Syscall tracing can modify the registers. */ 953 ld [%sp + STACKFRAME_SZ + PT_G1], %g1 954 sethi %hi(sys_call_table), %l7 955 ld [%sp + STACKFRAME_SZ + PT_I0], %i0 956 or %l7, %lo(sys_call_table), %l7 957 ld [%sp + STACKFRAME_SZ + PT_I1], %i1 958 ld [%sp + STACKFRAME_SZ + PT_I2], %i2 959 ld [%sp + STACKFRAME_SZ + PT_I3], %i3 960 ld [%sp + STACKFRAME_SZ + PT_I4], %i4 961 ld [%sp + STACKFRAME_SZ + PT_I5], %i5 962 cmp %g1, NR_syscalls 963 bgeu 3f 964 mov -ENOSYS, %o0 965 966 sll %g1, 2, %l4 967 mov %i0, %o0 968 ld [%l7 + %l4], %l7 969 mov %i1, %o1 970 mov %i2, %o2 971 mov %i3, %o3 972 b 2f 973 mov %i4, %o4 974 975 .globl ret_from_fork 976ret_from_fork: 977 call schedule_tail 978 ld [%g3 + TI_TASK], %o0 979 b ret_sys_call 980 ld [%sp + STACKFRAME_SZ + PT_I0], %o0 981 982 .globl ret_from_kernel_thread 983ret_from_kernel_thread: 984 call schedule_tail 985 ld [%g3 + TI_TASK], %o0 986 ld [%sp + STACKFRAME_SZ + PT_G1], %l0 987 call %l0 988 ld [%sp + STACKFRAME_SZ + PT_G2], %o0 989 rd %psr, %l1 990 ld [%sp + STACKFRAME_SZ + PT_PSR], %l0 991 andn %l0, PSR_CWP, %l0 992 nop 993 and %l1, PSR_CWP, %l1 994 or %l0, %l1, %l0 995 st %l0, [%sp + STACKFRAME_SZ + PT_PSR] 996 b ret_sys_call 997 mov 0, %o0 998 999 /* Linux native system calls enter here... */ 1000 .align 4 1001 .globl linux_sparc_syscall 1002linux_sparc_syscall: 1003 sethi %hi(PSR_SYSCALL), %l4 1004 or %l0, %l4, %l0 1005 /* Direct access to user regs, must faster. */ 1006 cmp %g1, NR_syscalls 1007 bgeu linux_sparc_ni_syscall 1008 sll %g1, 2, %l4 1009 ld [%l7 + %l4], %l7 1010 1011do_syscall: 1012 SAVE_ALL_HEAD 1013 rd %wim, %l3 1014 1015 wr %l0, PSR_ET, %psr 1016 mov %i0, %o0 1017 mov %i1, %o1 1018 mov %i2, %o2 1019 1020 ld [%curptr + TI_FLAGS], %l5 1021 mov %i3, %o3 1022 andcc %l5, _TIF_SYSCALL_TRACE, %g0 1023 mov %i4, %o4 1024 bne linux_syscall_trace 1025 mov %i0, %l5 10262: 1027 call %l7 1028 mov %i5, %o5 1029 10303: 1031 st %o0, [%sp + STACKFRAME_SZ + PT_I0] 1032 1033ret_sys_call: 1034 ld [%curptr + TI_FLAGS], %l6 1035 cmp %o0, -ERESTART_RESTARTBLOCK 1036 ld [%sp + STACKFRAME_SZ + PT_PSR], %g3 1037 set PSR_C, %g2 1038 bgeu 1f 1039 andcc %l6, _TIF_SYSCALL_TRACE, %g0 1040 1041 /* System call success, clear Carry condition code. */ 1042 andn %g3, %g2, %g3 1043 clr %l6 1044 st %g3, [%sp + STACKFRAME_SZ + PT_PSR] 1045 bne linux_syscall_trace2 1046 ld [%sp + STACKFRAME_SZ + PT_NPC], %l1 /* pc = npc */ 1047 add %l1, 0x4, %l2 /* npc = npc+4 */ 1048 st %l1, [%sp + STACKFRAME_SZ + PT_PC] 1049 b ret_trap_entry 1050 st %l2, [%sp + STACKFRAME_SZ + PT_NPC] 10511: 1052 /* System call failure, set Carry condition code. 1053 * Also, get abs(errno) to return to the process. 1054 */ 1055 sub %g0, %o0, %o0 1056 or %g3, %g2, %g3 1057 st %o0, [%sp + STACKFRAME_SZ + PT_I0] 1058 mov 1, %l6 1059 st %g3, [%sp + STACKFRAME_SZ + PT_PSR] 1060 bne linux_syscall_trace2 1061 ld [%sp + STACKFRAME_SZ + PT_NPC], %l1 /* pc = npc */ 1062 add %l1, 0x4, %l2 /* npc = npc+4 */ 1063 st %l1, [%sp + STACKFRAME_SZ + PT_PC] 1064 b ret_trap_entry 1065 st %l2, [%sp + STACKFRAME_SZ + PT_NPC] 1066 1067linux_syscall_trace2: 1068 add %sp, STACKFRAME_SZ, %o0 1069 mov 1, %o1 1070 call syscall_trace 1071 add %l1, 0x4, %l2 /* npc = npc+4 */ 1072 st %l1, [%sp + STACKFRAME_SZ + PT_PC] 1073 b ret_trap_entry 1074 st %l2, [%sp + STACKFRAME_SZ + PT_NPC] 1075 1076 1077/* Saving and restoring the FPU state is best done from lowlevel code. 1078 * 1079 * void fpsave(unsigned long *fpregs, unsigned long *fsr, 1080 * void *fpqueue, unsigned long *fpqdepth) 1081 */ 1082 1083 .globl fpsave 1084fpsave: 1085 st %fsr, [%o1] ! this can trap on us if fpu is in bogon state 1086 ld [%o1], %g1 1087 set 0x2000, %g4 1088 andcc %g1, %g4, %g0 1089 be 2f 1090 mov 0, %g2 1091 1092 /* We have an fpqueue to save. */ 10931: 1094 std %fq, [%o2] 1095fpsave_magic: 1096 st %fsr, [%o1] 1097 ld [%o1], %g3 1098 andcc %g3, %g4, %g0 1099 add %g2, 1, %g2 1100 bne 1b 1101 add %o2, 8, %o2 1102 11032: 1104 st %g2, [%o3] 1105 1106 std %f0, [%o0 + 0x00] 1107 std %f2, [%o0 + 0x08] 1108 std %f4, [%o0 + 0x10] 1109 std %f6, [%o0 + 0x18] 1110 std %f8, [%o0 + 0x20] 1111 std %f10, [%o0 + 0x28] 1112 std %f12, [%o0 + 0x30] 1113 std %f14, [%o0 + 0x38] 1114 std %f16, [%o0 + 0x40] 1115 std %f18, [%o0 + 0x48] 1116 std %f20, [%o0 + 0x50] 1117 std %f22, [%o0 + 0x58] 1118 std %f24, [%o0 + 0x60] 1119 std %f26, [%o0 + 0x68] 1120 std %f28, [%o0 + 0x70] 1121 retl 1122 std %f30, [%o0 + 0x78] 1123 1124 /* Thanks for Theo Deraadt and the authors of the Sprite/netbsd/openbsd 1125 * code for pointing out this possible deadlock, while we save state 1126 * above we could trap on the fsr store so our low level fpu trap 1127 * code has to know how to deal with this. 1128 */ 1129fpsave_catch: 1130 b fpsave_magic + 4 1131 st %fsr, [%o1] 1132 1133fpsave_catch2: 1134 b fpsave + 4 1135 st %fsr, [%o1] 1136 1137 /* void fpload(unsigned long *fpregs, unsigned long *fsr); */ 1138 1139 .globl fpload 1140fpload: 1141 ldd [%o0 + 0x00], %f0 1142 ldd [%o0 + 0x08], %f2 1143 ldd [%o0 + 0x10], %f4 1144 ldd [%o0 + 0x18], %f6 1145 ldd [%o0 + 0x20], %f8 1146 ldd [%o0 + 0x28], %f10 1147 ldd [%o0 + 0x30], %f12 1148 ldd [%o0 + 0x38], %f14 1149 ldd [%o0 + 0x40], %f16 1150 ldd [%o0 + 0x48], %f18 1151 ldd [%o0 + 0x50], %f20 1152 ldd [%o0 + 0x58], %f22 1153 ldd [%o0 + 0x60], %f24 1154 ldd [%o0 + 0x68], %f26 1155 ldd [%o0 + 0x70], %f28 1156 ldd [%o0 + 0x78], %f30 1157 ld [%o1], %fsr 1158 retl 1159 nop 1160 1161 /* __ndelay and __udelay take two arguments: 1162 * 0 - nsecs or usecs to delay 1163 * 1 - per_cpu udelay_val (loops per jiffy) 1164 * 1165 * Note that ndelay gives HZ times higher resolution but has a 10ms 1166 * limit. udelay can handle up to 1s. 1167 */ 1168 .globl __ndelay 1169__ndelay: 1170 save %sp, -STACKFRAME_SZ, %sp 1171 mov %i0, %o0 ! round multiplier up so large ns ok 1172 mov 0x1ae, %o1 ! 2**32 / (1 000 000 000 / HZ) 1173 umul %o0, %o1, %o0 1174 rd %y, %o1 1175 mov %i1, %o1 ! udelay_val 1176 umul %o0, %o1, %o0 1177 rd %y, %o1 1178 ba delay_continue 1179 mov %o1, %o0 ! >>32 later for better resolution 1180 1181 .globl __udelay 1182__udelay: 1183 save %sp, -STACKFRAME_SZ, %sp 1184 mov %i0, %o0 1185 sethi %hi(0x10c7), %o1 ! round multiplier up so large us ok 1186 or %o1, %lo(0x10c7), %o1 ! 2**32 / 1 000 000 1187 umul %o0, %o1, %o0 1188 rd %y, %o1 1189 mov %i1, %o1 ! udelay_val 1190 umul %o0, %o1, %o0 1191 rd %y, %o1 1192 sethi %hi(0x028f4b62), %l0 ! Add in rounding constant * 2**32, 1193 or %g0, %lo(0x028f4b62), %l0 1194 addcc %o0, %l0, %o0 ! 2**32 * 0.009 999 1195 bcs,a 3f 1196 add %o1, 0x01, %o1 11973: 1198 mov HZ, %o0 ! >>32 earlier for wider range 1199 umul %o0, %o1, %o0 1200 rd %y, %o1 1201 1202delay_continue: 1203 cmp %o0, 0x0 12041: 1205 bne 1b 1206 subcc %o0, 1, %o0 1207 1208 ret 1209 restore 1210 1211 /* Handle a software breakpoint */ 1212 /* We have to inform parent that child has stopped */ 1213 .align 4 1214 .globl breakpoint_trap 1215breakpoint_trap: 1216 rd %wim,%l3 1217 SAVE_ALL 1218 wr %l0, PSR_ET, %psr 1219 WRITE_PAUSE 1220 1221 st %i0, [%sp + STACKFRAME_SZ + PT_G0] ! for restarting syscalls 1222 call sparc_breakpoint 1223 add %sp, STACKFRAME_SZ, %o0 1224 1225 RESTORE_ALL 1226 1227#ifdef CONFIG_KGDB 1228 .align 4 1229 .globl kgdb_trap_low 1230 .type kgdb_trap_low,#function 1231kgdb_trap_low: 1232 rd %wim,%l3 1233 SAVE_ALL 1234 wr %l0, PSR_ET, %psr 1235 WRITE_PAUSE 1236 1237 call kgdb_trap 1238 add %sp, STACKFRAME_SZ, %o0 1239 1240 RESTORE_ALL 1241 .size kgdb_trap_low,.-kgdb_trap_low 1242#endif 1243 1244 .align 4 1245 .globl flush_patch_exception 1246flush_patch_exception: 1247 FLUSH_ALL_KERNEL_WINDOWS; 1248 ldd [%o0], %o6 1249 jmpl %o7 + 0xc, %g0 ! see asm-sparc/processor.h 1250 mov 1, %g1 ! signal EFAULT condition 1251 1252 .align 4 1253 .globl kill_user_windows, kuw_patch1_7win 1254 .globl kuw_patch1 1255kuw_patch1_7win: sll %o3, 6, %o3 1256 1257 /* No matter how much overhead this routine has in the worst 1258 * case scenerio, it is several times better than taking the 1259 * traps with the old method of just doing flush_user_windows(). 1260 */ 1261kill_user_windows: 1262 ld [%g6 + TI_UWINMASK], %o0 ! get current umask 1263 orcc %g0, %o0, %g0 ! if no bits set, we are done 1264 be 3f ! nothing to do 1265 rd %psr, %o5 ! must clear interrupts 1266 or %o5, PSR_PIL, %o4 ! or else that could change 1267 wr %o4, 0x0, %psr ! the uwinmask state 1268 WRITE_PAUSE ! burn them cycles 12691: 1270 ld [%g6 + TI_UWINMASK], %o0 ! get consistent state 1271 orcc %g0, %o0, %g0 ! did an interrupt come in? 1272 be 4f ! yep, we are done 1273 rd %wim, %o3 ! get current wim 1274 srl %o3, 1, %o4 ! simulate a save 1275kuw_patch1: 1276 sll %o3, 7, %o3 ! compute next wim 1277 or %o4, %o3, %o3 ! result 1278 andncc %o0, %o3, %o0 ! clean this bit in umask 1279 bne kuw_patch1 ! not done yet 1280 srl %o3, 1, %o4 ! begin another save simulation 1281 wr %o3, 0x0, %wim ! set the new wim 1282 st %g0, [%g6 + TI_UWINMASK] ! clear uwinmask 12834: 1284 wr %o5, 0x0, %psr ! re-enable interrupts 1285 WRITE_PAUSE ! burn baby burn 12863: 1287 retl ! return 1288 st %g0, [%g6 + TI_W_SAVED] ! no windows saved 1289 1290 .align 4 1291 .globl restore_current 1292restore_current: 1293 LOAD_CURRENT(g6, o0) 1294 retl 1295 nop 1296 1297#ifdef CONFIG_PCIC_PCI 1298#include <asm/pcic.h> 1299 1300 .align 4 1301 .globl linux_trap_ipi15_pcic 1302linux_trap_ipi15_pcic: 1303 rd %wim, %l3 1304 SAVE_ALL 1305 1306 /* 1307 * First deactivate NMI 1308 * or we cannot drop ET, cannot get window spill traps. 1309 * The busy loop is necessary because the PIO error 1310 * sometimes does not go away quickly and we trap again. 1311 */ 1312 sethi %hi(pcic_regs), %o1 1313 ld [%o1 + %lo(pcic_regs)], %o2 1314 1315 ! Get pending status for printouts later. 1316 ld [%o2 + PCI_SYS_INT_PENDING], %o0 1317 1318 mov PCI_SYS_INT_PENDING_CLEAR_ALL, %o1 1319 stb %o1, [%o2 + PCI_SYS_INT_PENDING_CLEAR] 13201: 1321 ld [%o2 + PCI_SYS_INT_PENDING], %o1 1322 andcc %o1, ((PCI_SYS_INT_PENDING_PIO|PCI_SYS_INT_PENDING_PCI)>>24), %g0 1323 bne 1b 1324 nop 1325 1326 or %l0, PSR_PIL, %l4 1327 wr %l4, 0x0, %psr 1328 WRITE_PAUSE 1329 wr %l4, PSR_ET, %psr 1330 WRITE_PAUSE 1331 1332 call pcic_nmi 1333 add %sp, STACKFRAME_SZ, %o1 ! struct pt_regs *regs 1334 RESTORE_ALL 1335 1336 .globl pcic_nmi_trap_patch 1337pcic_nmi_trap_patch: 1338 sethi %hi(linux_trap_ipi15_pcic), %l3 1339 jmpl %l3 + %lo(linux_trap_ipi15_pcic), %g0 1340 rd %psr, %l0 1341 .word 0 1342 1343#endif /* CONFIG_PCIC_PCI */ 1344 1345 .globl flushw_all 1346flushw_all: 1347 save %sp, -0x40, %sp 1348 save %sp, -0x40, %sp 1349 save %sp, -0x40, %sp 1350 save %sp, -0x40, %sp 1351 save %sp, -0x40, %sp 1352 save %sp, -0x40, %sp 1353 save %sp, -0x40, %sp 1354 restore 1355 restore 1356 restore 1357 restore 1358 restore 1359 restore 1360 ret 1361 restore 1362 1363#ifdef CONFIG_SMP 1364ENTRY(hard_smp_processor_id) 1365661: rd %tbr, %g1 1366 srl %g1, 12, %o0 1367 and %o0, 3, %o0 1368 .section .cpuid_patch, "ax" 1369 /* Instruction location. */ 1370 .word 661b 1371 /* SUN4D implementation. */ 1372 lda [%g0] ASI_M_VIKING_TMP1, %o0 1373 nop 1374 nop 1375 /* LEON implementation. */ 1376 rd %asr17, %o0 1377 srl %o0, 0x1c, %o0 1378 nop 1379 .previous 1380 retl 1381 nop 1382ENDPROC(hard_smp_processor_id) 1383#endif 1384 1385/* End of entry.S */ 1386