root / target-ppc / op_helper_mem.h @ 76a66253
History | View | Annotate | Download (5.7 kB)
1 |
/*
|
---|---|
2 |
* PowerPC emulation micro-operations helpers for qemu.
|
3 |
*
|
4 |
* Copyright (c) 2003-2007 Jocelyn Mayer
|
5 |
*
|
6 |
* This library is free software; you can redistribute it and/or
|
7 |
* modify it under the terms of the GNU Lesser General Public
|
8 |
* License as published by the Free Software Foundation; either
|
9 |
* version 2 of the License, or (at your option) any later version.
|
10 |
*
|
11 |
* This library is distributed in the hope that it will be useful,
|
12 |
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
13 |
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
14 |
* Lesser General Public License for more details.
|
15 |
*
|
16 |
* You should have received a copy of the GNU Lesser General Public
|
17 |
* License along with this library; if not, write to the Free Software
|
18 |
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
19 |
*/
|
20 |
|
21 |
/* Multiple word / string load and store */
|
22 |
static inline target_ulong glue(ld32r, MEMSUFFIX) (target_ulong EA) |
23 |
{ |
24 |
uint32_t tmp = glue(ldl, MEMSUFFIX)(EA); |
25 |
return ((tmp & 0xFF000000UL) >> 24) | ((tmp & 0x00FF0000UL) >> 8) | |
26 |
((tmp & 0x0000FF00UL) << 8) | ((tmp & 0x000000FFUL) << 24); |
27 |
} |
28 |
|
29 |
static inline void glue(st32r, MEMSUFFIX) (target_ulong EA, target_ulong data) |
30 |
{ |
31 |
uint32_t tmp = |
32 |
((data & 0xFF000000UL) >> 24) | ((data & 0x00FF0000UL) >> 8) | |
33 |
((data & 0x0000FF00UL) << 8) | ((data & 0x000000FFUL) << 24); |
34 |
glue(stl, MEMSUFFIX)(EA, tmp); |
35 |
} |
36 |
|
37 |
void glue(do_lmw, MEMSUFFIX) (int dst) |
38 |
{ |
39 |
for (; dst < 32; dst++, T0 += 4) { |
40 |
ugpr(dst) = glue(ldl, MEMSUFFIX)(T0); |
41 |
} |
42 |
} |
43 |
|
44 |
void glue(do_stmw, MEMSUFFIX) (int src) |
45 |
{ |
46 |
for (; src < 32; src++, T0 += 4) { |
47 |
glue(stl, MEMSUFFIX)(T0, ugpr(src)); |
48 |
} |
49 |
} |
50 |
|
51 |
void glue(do_lmw_le, MEMSUFFIX) (int dst) |
52 |
{ |
53 |
for (; dst < 32; dst++, T0 += 4) { |
54 |
ugpr(dst) = glue(ld32r, MEMSUFFIX)(T0); |
55 |
} |
56 |
} |
57 |
|
58 |
void glue(do_stmw_le, MEMSUFFIX) (int src) |
59 |
{ |
60 |
for (; src < 32; src++, T0 += 4) { |
61 |
glue(st32r, MEMSUFFIX)(T0, ugpr(src)); |
62 |
} |
63 |
} |
64 |
|
65 |
void glue(do_lsw, MEMSUFFIX) (int dst) |
66 |
{ |
67 |
uint32_t tmp; |
68 |
int sh;
|
69 |
|
70 |
for (; T1 > 3; T1 -= 4, T0 += 4) { |
71 |
ugpr(dst++) = glue(ldl, MEMSUFFIX)(T0); |
72 |
if (unlikely(dst == 32)) |
73 |
dst = 0;
|
74 |
} |
75 |
if (unlikely(T1 != 0)) { |
76 |
tmp = 0;
|
77 |
for (sh = 24; T1 > 0; T1--, T0++, sh -= 8) { |
78 |
tmp |= glue(ldub, MEMSUFFIX)(T0) << sh; |
79 |
} |
80 |
ugpr(dst) = tmp; |
81 |
} |
82 |
} |
83 |
|
84 |
void glue(do_stsw, MEMSUFFIX) (int src) |
85 |
{ |
86 |
int sh;
|
87 |
|
88 |
for (; T1 > 3; T1 -= 4, T0 += 4) { |
89 |
glue(stl, MEMSUFFIX)(T0, ugpr(src++)); |
90 |
if (unlikely(src == 32)) |
91 |
src = 0;
|
92 |
} |
93 |
if (unlikely(T1 != 0)) { |
94 |
for (sh = 24; T1 > 0; T1--, T0++, sh -= 8) |
95 |
glue(stb, MEMSUFFIX)(T0, (ugpr(src) >> sh) & 0xFF);
|
96 |
} |
97 |
} |
98 |
|
99 |
void glue(do_lsw_le, MEMSUFFIX) (int dst) |
100 |
{ |
101 |
uint32_t tmp; |
102 |
int sh;
|
103 |
|
104 |
for (; T1 > 3; T1 -= 4, T0 += 4) { |
105 |
ugpr(dst++) = glue(ld32r, MEMSUFFIX)(T0); |
106 |
if (unlikely(dst == 32)) |
107 |
dst = 0;
|
108 |
} |
109 |
if (unlikely(T1 != 0)) { |
110 |
tmp = 0;
|
111 |
for (sh = 0; T1 > 0; T1--, T0++, sh += 8) { |
112 |
tmp |= glue(ldub, MEMSUFFIX)(T0) << sh; |
113 |
} |
114 |
ugpr(dst) = tmp; |
115 |
} |
116 |
} |
117 |
|
118 |
void glue(do_stsw_le, MEMSUFFIX) (int src) |
119 |
{ |
120 |
int sh;
|
121 |
|
122 |
for (; T1 > 3; T1 -= 4, T0 += 4) { |
123 |
glue(st32r, MEMSUFFIX)(T0, ugpr(src++)); |
124 |
if (unlikely(src == 32)) |
125 |
src = 0;
|
126 |
} |
127 |
if (unlikely(T1 != 0)) { |
128 |
for (sh = 0; T1 > 0; T1--, T0++, sh += 8) |
129 |
glue(stb, MEMSUFFIX)(T0, (ugpr(src) >> sh) & 0xFF);
|
130 |
} |
131 |
} |
132 |
|
133 |
/* PPC 601 specific instructions (POWER bridge) */
|
134 |
// XXX: to be tested
|
135 |
void glue(do_POWER_lscbx, MEMSUFFIX) (int dest, int ra, int rb) |
136 |
{ |
137 |
int i, c, d, reg;
|
138 |
|
139 |
d = 24;
|
140 |
reg = dest; |
141 |
for (i = 0; i < T1; i++) { |
142 |
c = glue(ldub, MEMSUFFIX)(T0++); |
143 |
/* ra (if not 0) and rb are never modified */
|
144 |
if (likely(reg != rb && (ra == 0 || reg != ra))) { |
145 |
ugpr(reg) = (ugpr(reg) & ~(0xFF << d)) | (c << d);
|
146 |
} |
147 |
if (unlikely(c == T2))
|
148 |
break;
|
149 |
if (likely(d != 0)) { |
150 |
d -= 8;
|
151 |
} else {
|
152 |
d = 24;
|
153 |
reg++; |
154 |
reg = reg & 0x1F;
|
155 |
} |
156 |
} |
157 |
T0 = i; |
158 |
} |
159 |
|
160 |
/* XXX: TAGs are not managed */
|
161 |
void glue(do_POWER2_lfq, MEMSUFFIX) (void) |
162 |
{ |
163 |
FT0 = glue(ldfq, MEMSUFFIX)(T0); |
164 |
FT1 = glue(ldfq, MEMSUFFIX)(T0 + 4);
|
165 |
} |
166 |
|
167 |
static inline double glue(ldfqr, MEMSUFFIX) (target_ulong EA) |
168 |
{ |
169 |
union {
|
170 |
double d;
|
171 |
uint64_t u; |
172 |
} u; |
173 |
|
174 |
u.d = glue(ldfq, MEMSUFFIX)(EA); |
175 |
u.u = ((u.u & 0xFF00000000000000ULL) >> 56) | |
176 |
((u.u & 0x00FF000000000000ULL) >> 40) | |
177 |
((u.u & 0x0000FF0000000000ULL) >> 24) | |
178 |
((u.u & 0x000000FF00000000ULL) >> 8) | |
179 |
((u.u & 0x00000000FF000000ULL) << 8) | |
180 |
((u.u & 0x0000000000FF0000ULL) << 24) | |
181 |
((u.u & 0x000000000000FF00ULL) << 40) | |
182 |
((u.u & 0x00000000000000FFULL) << 56); |
183 |
|
184 |
return u.d;
|
185 |
} |
186 |
|
187 |
void glue(do_POWER2_lfq_le, MEMSUFFIX) (void) |
188 |
{ |
189 |
FT0 = glue(ldfqr, MEMSUFFIX)(T0 + 4);
|
190 |
FT1 = glue(ldfqr, MEMSUFFIX)(T0); |
191 |
} |
192 |
|
193 |
void glue(do_POWER2_stfq, MEMSUFFIX) (void) |
194 |
{ |
195 |
glue(stfq, MEMSUFFIX)(T0, FT0); |
196 |
glue(stfq, MEMSUFFIX)(T0 + 4, FT1);
|
197 |
} |
198 |
|
199 |
static inline void glue(stfqr, MEMSUFFIX) (target_ulong EA, double d) |
200 |
{ |
201 |
union {
|
202 |
double d;
|
203 |
uint64_t u; |
204 |
} u; |
205 |
|
206 |
u.d = d; |
207 |
u.u = ((u.u & 0xFF00000000000000ULL) >> 56) | |
208 |
((u.u & 0x00FF000000000000ULL) >> 40) | |
209 |
((u.u & 0x0000FF0000000000ULL) >> 24) | |
210 |
((u.u & 0x000000FF00000000ULL) >> 8) | |
211 |
((u.u & 0x00000000FF000000ULL) << 8) | |
212 |
((u.u & 0x0000000000FF0000ULL) << 24) | |
213 |
((u.u & 0x000000000000FF00ULL) << 40) | |
214 |
((u.u & 0x00000000000000FFULL) << 56); |
215 |
glue(stfq, MEMSUFFIX)(EA, u.d); |
216 |
} |
217 |
|
218 |
void glue(do_POWER2_stfq_le, MEMSUFFIX) (void) |
219 |
{ |
220 |
glue(stfqr, MEMSUFFIX)(T0 + 4, FT0);
|
221 |
glue(stfqr, MEMSUFFIX)(T0, FT1); |
222 |
} |
223 |
|
224 |
#undef MEMSUFFIX
|