1 /*-
2 * Copyright (C) 2015 Nathan Whitehorn
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
18 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
19 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
20 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
21 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
22 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
23 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 *
25 * $FreeBSD$
26 */
27
28 #include <machine/asm.h>
29
30 #include "opt_platform.h"
31
32 GLOBAL(opal_entrypoint)
33 .llong 0
34 GLOBAL(opal_data)
35 .llong 0
36 GLOBAL(opal_msr)
37 .llong 0
38
39 TOC_ENTRY(opal_entrypoint)
40 TOC_ENTRY(opal_data)
41 TOC_ENTRY(opal_msr)
42
43 ASENTRY(opal_call)
44 /* Args:
45 * r3: opal token
46 * r4-r10 opal arguments
47 */
48
49 /* Save call stuff on stack */
50 mflr %r0
51 std %r0,16(%r1)
52 std %r2,-16(%r1)
53 mfcr %r0
54 std %r0,8(%r1)
55
56 /* Load OPAL entry information */
57 mr %r0,%r3
58 addis %r3,%r2,TOC_REF(opal_entrypoint)@ha
59 ld %r3,TOC_REF(opal_entrypoint)@l(%r3)
60 ld %r3,0(%r3)
61 mtctr %r3
62
63 /* Save MSR in non-volatile scratch register and turn off translation */
64 std %r31,-8(%r1)
65 mfmsr %r31
66
67 /* Load last bits from the TOC */
68 addis %r3,%r2,TOC_REF(opal_msr)@ha
69 ld %r3,TOC_REF(opal_msr)@l(%r3)
70 ld %r3,0(%r3)
71 addis %r2,%r2,TOC_REF(opal_data)@ha
72 ld %r2,TOC_REF(opal_data)@l(%r2)
73 ld %r2,0(%r2)
74
75
76 #if defined(__LITTLE_ENDIAN__) && defined(QEMU)
77 /* QEMU hack: qemu does not emulate mtmsrd correctly! */
78 ori %r3,%r3,1 /* Leave PSR_LE set */
79 #endif
80 mtmsrd %r3
81 isync
82 #if defined(__LITTLE_ENDIAN__) && defined(QEMU)
83 /* Clean up from qemu hack */
84 xori %r3,%r3,1
85 #endif
86
87 #ifdef __LITTLE_ENDIAN__
88 mtsrr1 %r3
89 #endif
90
91 /* Shift registers over */
92 mr %r3,%r4
93 mr %r4,%r5
94 mr %r5,%r6
95 mr %r6,%r7
96 mr %r7,%r8
97 mr %r8,%r9
98 mr %r9,%r10
99
100 #ifdef __LITTLE_ENDIAN__
101 /* We need to rfid to switch endian. */
102 mfctr %r11
103 mtsrr0 %r11
104 LOAD_LR_NIA
105 1:
106 mflr %r11
107 addi %r11, %r11, (2f-1b)
108 mtlr %r11
109 /* Call OPAL */
110 rfid
111 2:
112 RETURN_TO_NATIVE_ENDIAN
113 #else
114 /* Call OPAL */
115 bctrl
116 #endif
117
118 /* Restore MSR */
119 mtmsrd %r31
120 isync
121 ld %r31,-8(%r1)
122
123 /* Restore call stuff from stack */
124 ld %r0,16(%r1)
125 mtlr %r0
126 ld %r2,-16(%r1)
127 ld %r0,8(%r1)
128 mtcr %r0
129
130 /* And return */
131 blr
132 ASEND(opal_call)
Cache object: 993d026a40250cf3206c34fecb3059d2
|