| #include "cpustate.h" |
| |
| .globl sparc64_of_client_interface, client_tba |
| |
| |
| /* |
| * SAVE_WINDOW_STATE and RESTORE_WINDOW_STATE are used to ensure |
| * that the CPU window state is preserved across CIF calls. This is |
| * to workaround a *BSD restriction that window fill/spill traps must |
| * be minimised during trap table takeover, and likely emulates the |
| * behaviour of OBP. |
| */ |
| |
| .data |
| .align 8 |
| |
| client_context: |
| .xword 0 |
| client_stack: |
| .xword 0 |
| client_window: |
| .skip 2048 |
| |
| |
| .text |
| .align 4 |
| .register %g2, #scratch |
| .register %g3, #scratch |
| .register %g6, #scratch |
| .register %g7, #scratch |
| /* |
| make some more space on stack since linux kernel only provides 128 bytes |
| without memory to spill registers (used by gcc in -O0 mode) |
| */ |
| |
| sparc64_of_client_interface: |
| |
| /* Save globals on callers stack */ |
| stx %g1, [%sp + 2047 - 248 + 192] |
| stx %g2, [%sp + 2047 - 248 + 200] |
| stx %g3, [%sp + 2047 - 248 + 208] |
| stx %g4, [%sp + 2047 - 248 + 216] |
| stx %g5, [%sp + 2047 - 248 + 224] |
| stx %g6, [%sp + 2047 - 248 + 232] |
| stx %g7, [%sp + 2047 - 248 + 240] |
| |
| /* Save existing stack */ |
| setx client_stack, %g6, %g7 |
| stx %sp, [%g7] |
| |
| /* Save windows */ |
| setx _fcstack_ptr, %g6, %g7 |
| ldx [%g7], %g1 |
| add %g1, -CONTEXT_STATE_SIZE, %g1 |
| stx %g1, [%g7] |
| |
| /* Save globals */ |
| ldx [%sp + 2047 - 248 + 192], %g7 |
| stx %g7, [%g1 + 0x30] |
| ldx [%sp + 2047 - 248 + 200], %g7 |
| stx %g7, [%g1 + 0x38] |
| ldx [%sp + 2047 - 248 + 208], %g7 |
| stx %g7, [%g1 + 0x40] |
| ldx [%sp + 2047 - 248 + 216], %g7 |
| stx %g7, [%g1 + 0x48] |
| ldx [%sp + 2047 - 248 + 224], %g7 |
| stx %g7, [%g1 + 0x50] |
| ldx [%sp + 2047 - 248 + 232], %g7 |
| stx %g7, [%g1 + 0x58] |
| ldx [%sp + 2047 - 248 + 240], %g7 |
| stx %g7, [%g1 + 0x60] |
| |
| /* Save %pc */ |
| mov %o7, %g7 |
| add %g7, 8, %g7 |
| stx %g7, [%g1 + 0x4d0] |
| |
| SAVE_CPU_STATE(cif) |
| |
| RESET_CPU_WINDOW_STATE(cif) |
| |
| /* Update __context to point to saved area */ |
| setx __context, %g6, %g7 |
| ldx [%g7], %g3 |
| setx client_context, %g4, %g5 |
| stx %g3, [%g5] |
| stx %g1, [%g7] |
| |
| /* Move to OpenBIOS context stack */ |
| setx _fcstack_ptr, %g6, %g7 |
| ldx [%g7], %g6 |
| setx CONTEXT_STACK_SIZE, %g4, %g5 |
| sub %g6, %g5, %g6 |
| stx %g6, [%g7] |
| |
| setx - 2047 - 192, %g6, %g7 |
| add %g1, %g7, %g7 |
| mov %g7, %sp |
| |
| /* Call client inteface */ |
| call of_client_interface |
| ldx [%g1 + 0x70], %o0 |
| |
| /* Restore windows */ |
| setx _fcstack_ptr, %g6, %g7 |
| ldx [%g7], %g1 |
| setx CONTEXT_STACK_SIZE, %g4, %g5 |
| add %g1, %g5, %g1 |
| stx %g1, [%g7] |
| |
| /* Return value */ |
| stx %o0, [%g1 + 0x70] |
| |
| /* Restore __context */ |
| setx client_context, %g4, %g5 |
| ldx [%g5], %g3 |
| setx __context, %g6, %g7 |
| stx %g3, [%g7] |
| |
| RESTORE_CPU_STATE(cif) |
| |
| add %g1, CONTEXT_STATE_SIZE, %g5 |
| setx _fcstack_ptr, %g6, %g7 |
| stx %g5, [%g7] |
| |
| /* Restore stack */ |
| setx client_stack, %g6, %g7 |
| ldx [%g7], %sp |
| |
| /* Restore %pc */ |
| ldx [%g1 + 0x4d0], %o7 |
| |
| /* Restore globals */ |
| ldx [%g1 + 0x38], %g2 |
| ldx [%g1 + 0x40], %g3 |
| ldx [%g1 + 0x48], %g4 |
| ldx [%g1 + 0x50], %g5 |
| ldx [%g1 + 0x58], %g6 |
| ldx [%g1 + 0x60], %g7 |
| |
| jmp %o7 |
| ldx [%g1 + 0x30], %g1 |
