| /* |
| * 64-bit switch cpu code |
| * |
| * Copyright IBM Corp. 2009 |
| * |
| */ |
| |
| #include <asm/asm-offsets.h> |
| #include <asm/ptrace.h> |
| |
| # smp_switch_to_cpu switches to destination cpu and executes the passed function |
| # Parameter: %r2 - function to call |
| # %r3 - function parameter |
| # %r4 - stack poiner |
| # %r5 - current cpu |
| # %r6 - destination cpu |
| |
| .section .text |
| .align 4 |
| .globl smp_switch_to_cpu |
| smp_switch_to_cpu: |
| stmg %r6,%r15,__SF_GPRS(%r15) |
| lgr %r1,%r15 |
| aghi %r15,-STACK_FRAME_OVERHEAD |
| stg %r1,__SF_BACKCHAIN(%r15) |
| larl %r1,.gprregs |
| stmg %r0,%r15,0(%r1) |
| 1: sigp %r0,%r6,__SIGP_RESTART /* start destination CPU */ |
| brc 2,1b /* busy, try again */ |
| 2: sigp %r0,%r5,__SIGP_STOP /* stop current CPU */ |
| brc 2,2b /* busy, try again */ |
| 3: j 3b |
| |
| .globl smp_restart_cpu |
| smp_restart_cpu: |
| larl %r1,.gprregs |
| lmg %r0,%r15,0(%r1) |
| 1: sigp %r0,%r5,__SIGP_SENSE /* Wait for calling CPU */ |
| brc 10,1b /* busy, accepted (status 0), running */ |
| tmll %r0,0x40 /* Test if calling CPU is stopped */ |
| jz 1b |
| ltgr %r4,%r4 /* New stack ? */ |
| jz 1f |
| lgr %r15,%r4 |
| 1: lgr %r14,%r2 /* r14: Function to call */ |
| lgr %r2,%r3 /* r2 : Parameter for function*/ |
| basr %r14,%r14 /* Call function */ |
| |
| .section .data,"aw",@progbits |
| .gprregs: |
| .rept 16 |
| .quad 0 |
| .endr |