blob: dcff57ba095b3c0facd128139316c812c1ea00e8 [file] [log] [blame]
/******************************************************************************
* Copyright (c) 2004, 2008 IBM Corporation
* All rights reserved.
* This program and the accompanying materials
* are made available under the terms of the BSD License
* which accompanies this distribution, and is available at
* http://www.opensource.org/licenses/bsd-license.php
*
* Contributors:
* IBM Corporation - initial implementation
*****************************************************************************/
#include <macros.h>
#define STACKSIZE 0x2000
#
# The generic exception code.
#
# Enter with GPR0 = vector, SPRG0 = saved GPR0
#
.section ".entry_text"
the_handler:
.quad handler
eregs:
/* the_exception_frame is a C variable which is usually
* defined in $(TARG).c
* the_exception_frame can be accessed from paflof through
* the word eregs
* in the case an excpetion is handled paflof will read
* from eregs the values of all registers and print them
* out in the exception handler */
.quad the_exception_frame
handler:
mtsprg 1,1 # SPRG1 = saved GPR1
bcl 20,31,$+4
mflr 1
ld 1,eregs-$+4(1) # GPR1 = address of register save area
.irp i, 2,3,4,5,6,7,8,9,10,11,12,13,14,15, \
16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31
std \i,\i*8(1)
.endr # save GPR2..GPR31
li r3, 3 // GPR3 = mode (param_1, param_2)
mr 4,0 // GPR4 = vector
mfsprg 0,0
std 0,0(1) # save GPR0
mfsprg 0,1
std 0,8(1) # save GPR1
cmpwi r4, 0x900 # Decrementer interrupt
bne 0f
mfdec r5 # Save old value of decrementer as reason
lis r0,0x7fff # Set decrementer to highest value
mtdec r0
0:
mfcr 0
std 0,0x100(1)
mfxer 0
std 0,0x108(1)
mfsprg 0,3 # save lr
std 0,0x110(1)
mfsprg 0,2 # save ctr
std 0,0x118(1)
mfsrr0 0
std 0,0x120(1)
mfsrr1 0
std 0,0x128(1)
mfdar 0
std 0,0x130(1)
mfdsisr 0
std 0,0x138(1) # save special regs
bcl 20, 31, over
base:
.align 3
.the_system_stack:
.quad the_system_stack+STACKSIZE-base
over:
mflr r2 /* gpr 2 is the base */
ld r1, .the_system_stack-base(r2) /* load stack pointer */
add r1, r1, r2 /* add base */
li r0, 0
stdu r0, -0x10(r1)
stdu r1, -0x100(r1)
lis 2,engine@ha
ld 0,engine@l(2) # set up entry
mtsrr0 0
ld 2,8+engine@l(2) # set up TOC pointer
rfid
# b .engine # ...and run!
#
# Swap non-volatile client interface regs, plus GPR3..GPR7.
#
swap_ci_regs:
/* save lr */
mflr r0
/* let's find out where our client stack is */
bcl 20, 31, client_over
client_base:
.align 3
.the_client_frame:
.quad the_client_frame-client_base
client_over:
mflr r8 /* gpr 2 is the client_base */
mtlr r0 /* restore the original lr */
ld r0, .the_client_frame-client_base(r8)
add r8, r0, r8 /* add the client_base */
/* r8 now contains the address of the_client_frame */
.irp i, 1,2,3,4,5,6,7, \
13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31
ld 0,\i*8(8)
std \i,\i*8(8)
mr \i,0
.endr # swap GPR1..7, GPR13..31
ld 0,0x100(8)
mfcr 9
mtcrf 0xff,0
std 9,0x100(8) # swap CR
ld 0,0x128(8)
mfmsr 9
mtmsrd 0
sync
isync
std 9,0x128(8) # swap MSR
blr
#
# Entry point for the OF client interface.
#
.globl client_entry_point
.section ".opd","aw"
.align 3
client_entry_point:
.quad .client_entry_point,.TOC.@tocbase,0
.previous
.type .client_entry_point,@function
.globl .client_entry_point
.client_entry_point:
mflr 4
bl swap_ci_regs # swap regs
mtlr 4
li 3, 0 # client call
blr
#
# Start the client.
#
.globl call_client
.section ".opd","aw"
.align 3
call_client:
.quad .call_client,.TOC.@tocbase,0
.previous
.type .call_client,@function
.globl .call_client
.call_client: # called with r3 = address, returns r3
mflr 4
mtctr 3
bl swap_ci_regs
/* Check if LE loading */
cmpwi 0,13,1
beq 0f
bctrl
b 1f
0: /* handle LE */
mfmsr 13
xori 13,13,1
mtsrr1 13
mfctr 13
mr 12,13
mtsrr0 13
rfid
#if 0 /* in case we return back, still to be tested */
.long 0x05009f42; /* bcl 20,31,$+4 */
.long 0xa602c87d; /* mflr r14 */
.long 0x1c00ce39; /* addi r14,r14,28 */
.long 0xa600e07d; /* mfmsr r15 */
.long 0x0100ef69; /* xori r15,r15,1 */
.long 0xa603da7d; /* mtsrr0 r14 */
.long 0xa603fb7d; /* mtsrr1 r15 */
.long 0x2400004c; /* rfid */
#endif
1:
bl swap_ci_regs
mtlr 4
li 3, -1 # client app return
blr
.lcomm the_system_stack, STACKSIZE, 16