1
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
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
|
/******************************************************************************
* 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 <rtas.h>
/*
Function:
Input:
r3: rtas parm structure
r4: base address
Output:
Decription: Main entry point, called from OS. Second parameter is not
used.
*/
.globl rtas_entry
rtas_entry:
mfmsr r11 # Get MSR to enable 64-bit mode
mr r7,r11
rotldi r11,r11,1
ori r11,r11,1 # Always enable 64-bit mode flag
rotldi r11,r11,63
mtmsrd r11 # Switch to 64-bit mode
isync
mr r9,r1 # save old stack pointer
mflr r10 # save link register
bcl 20,31,.over # branch to over
.base:
.align 3
..got: .quad _got-.base+0x8000
..stack: .quad .stack+RTAS_STACKSIZE-0x60-.base
.over:
mflr r8 # gpr 8 is the base
ld r1,..stack-.base(r8) # load new stack pointer
add r1,r1,r8 # add base
std r2,64(r1) # save toc
ld r2,..got-.base(r8) # load got pointer
std r7,72(r1) # save original msr
std r10,80(r1) # save link register
std r9,0(r1) # save stack pointer
add r2,r2,r8 # add base
bl save_regs_r3_r12
bl .rtas_call
bl restore_regs_r3_r12
rtas_return:
ld r11,72(r1) # restore msr value
ld r0,80(r1) # restore link register value
ld r2,64(r1) # restore toc
ld r1,0(r1) # get old stack
mtmsrd r11 # restore msr (32 bit ?)
isync
mtlr r0
blr
.globl .stack
.lcomm .stack,RTAS_STACKSIZE
|
