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