2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License, version 2, as
4 * published by the Free Software Foundation.
6 * This program is distributed in the hope that it will be useful,
7 * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 * GNU General Public License for more details.
11 * You should have received a copy of the GNU General Public License
12 * along with this program; if not, write to the Free Software
13 * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
15 * Copyright SUSE Linux Products GmbH 2009
17 * Authors: Alexander Graf <agraf@suse.de>
20 #include <asm/kvm_ppc.h>
21 #include <asm/disassemble.h>
22 #include <asm/kvm_book3s.h>
25 #define OP_19_XOP_RFID 18
26 #define OP_19_XOP_RFI 50
28 #define OP_31_XOP_MFMSR 83
29 #define OP_31_XOP_MTMSR 146
30 #define OP_31_XOP_MTMSRD 178
31 #define OP_31_XOP_MTSRIN 242
32 #define OP_31_XOP_TLBIEL 274
33 #define OP_31_XOP_TLBIE 306
34 #define OP_31_XOP_SLBMTE 402
35 #define OP_31_XOP_SLBIE 434
36 #define OP_31_XOP_SLBIA 498
37 #define OP_31_XOP_MFSRIN 659
38 #define OP_31_XOP_SLBMFEV 851
39 #define OP_31_XOP_EIOIO 854
40 #define OP_31_XOP_SLBMFEE 915
42 /* DCBZ is actually 1014, but we patch it to 1010 so we get a trap */
43 #define OP_31_XOP_DCBZ 1010
45 int kvmppc_core_emulate_op(struct kvm_run
*run
, struct kvm_vcpu
*vcpu
,
46 unsigned int inst
, int *advance
)
48 int emulated
= EMULATE_DONE
;
50 switch (get_op(inst
)) {
52 switch (get_xop(inst
)) {
55 vcpu
->arch
.pc
= vcpu
->arch
.srr0
;
56 kvmppc_set_msr(vcpu
, vcpu
->arch
.srr1
);
61 emulated
= EMULATE_FAIL
;
66 switch (get_xop(inst
)) {
68 kvmppc_set_gpr(vcpu
, get_rt(inst
), vcpu
->arch
.msr
);
70 case OP_31_XOP_MTMSRD
:
72 ulong rs
= kvmppc_get_gpr(vcpu
, get_rs(inst
));
74 vcpu
->arch
.msr
&= ~(MSR_RI
| MSR_EE
);
75 vcpu
->arch
.msr
|= rs
& (MSR_RI
| MSR_EE
);
77 kvmppc_set_msr(vcpu
, rs
);
81 kvmppc_set_msr(vcpu
, kvmppc_get_gpr(vcpu
, get_rs(inst
)));
83 case OP_31_XOP_MFSRIN
:
87 srnum
= (kvmppc_get_gpr(vcpu
, get_rb(inst
)) >> 28) & 0xf;
88 if (vcpu
->arch
.mmu
.mfsrin
) {
90 sr
= vcpu
->arch
.mmu
.mfsrin(vcpu
, srnum
);
91 kvmppc_set_gpr(vcpu
, get_rt(inst
), sr
);
95 case OP_31_XOP_MTSRIN
:
96 vcpu
->arch
.mmu
.mtsrin(vcpu
,
97 (kvmppc_get_gpr(vcpu
, get_rb(inst
)) >> 28) & 0xf,
98 kvmppc_get_gpr(vcpu
, get_rs(inst
)));
100 case OP_31_XOP_TLBIE
:
101 case OP_31_XOP_TLBIEL
:
103 bool large
= (inst
& 0x00200000) ? true : false;
104 ulong addr
= kvmppc_get_gpr(vcpu
, get_rb(inst
));
105 vcpu
->arch
.mmu
.tlbie(vcpu
, addr
, large
);
108 case OP_31_XOP_EIOIO
:
110 case OP_31_XOP_SLBMTE
:
111 if (!vcpu
->arch
.mmu
.slbmte
)
114 vcpu
->arch
.mmu
.slbmte(vcpu
,
115 kvmppc_get_gpr(vcpu
, get_rs(inst
)),
116 kvmppc_get_gpr(vcpu
, get_rb(inst
)));
118 case OP_31_XOP_SLBIE
:
119 if (!vcpu
->arch
.mmu
.slbie
)
122 vcpu
->arch
.mmu
.slbie(vcpu
,
123 kvmppc_get_gpr(vcpu
, get_rb(inst
)));
125 case OP_31_XOP_SLBIA
:
126 if (!vcpu
->arch
.mmu
.slbia
)
129 vcpu
->arch
.mmu
.slbia(vcpu
);
131 case OP_31_XOP_SLBMFEE
:
132 if (!vcpu
->arch
.mmu
.slbmfee
) {
133 emulated
= EMULATE_FAIL
;
137 rb
= kvmppc_get_gpr(vcpu
, get_rb(inst
));
138 t
= vcpu
->arch
.mmu
.slbmfee(vcpu
, rb
);
139 kvmppc_set_gpr(vcpu
, get_rt(inst
), t
);
142 case OP_31_XOP_SLBMFEV
:
143 if (!vcpu
->arch
.mmu
.slbmfev
) {
144 emulated
= EMULATE_FAIL
;
148 rb
= kvmppc_get_gpr(vcpu
, get_rb(inst
));
149 t
= vcpu
->arch
.mmu
.slbmfev(vcpu
, rb
);
150 kvmppc_set_gpr(vcpu
, get_rt(inst
), t
);
155 ulong rb
= kvmppc_get_gpr(vcpu
, get_rb(inst
));
158 u32 zeros
[8] = { 0, 0, 0, 0, 0, 0, 0, 0 };
161 ra
= kvmppc_get_gpr(vcpu
, get_ra(inst
));
163 addr
= (ra
+ rb
) & ~31ULL;
164 if (!(vcpu
->arch
.msr
& MSR_SF
))
167 if (kvmppc_st(vcpu
, addr
, 32, zeros
)) {
168 vcpu
->arch
.dear
= addr
;
169 vcpu
->arch
.fault_dear
= addr
;
170 to_book3s(vcpu
)->dsisr
= DSISR_PROTFAULT
|
172 kvmppc_book3s_queue_irqprio(vcpu
,
173 BOOK3S_INTERRUPT_DATA_STORAGE
);
174 kvmppc_mmu_pte_flush(vcpu
, addr
, ~0xFFFULL
);
180 emulated
= EMULATE_FAIL
;
184 emulated
= EMULATE_FAIL
;
190 void kvmppc_set_bat(struct kvm_vcpu
*vcpu
, struct kvmppc_bat
*bat
, bool upper
,
195 u32 bl
= (val
>> 2) & 0x7ff;
196 bat
->bepi_mask
= (~bl
<< 17);
197 bat
->bepi
= val
& 0xfffe0000;
198 bat
->vs
= (val
& 2) ? 1 : 0;
199 bat
->vp
= (val
& 1) ? 1 : 0;
200 bat
->raw
= (bat
->raw
& 0xffffffff00000000ULL
) | val
;
203 bat
->brpn
= val
& 0xfffe0000;
204 bat
->wimg
= (val
>> 3) & 0xf;
206 bat
->raw
= (bat
->raw
& 0x00000000ffffffffULL
) | ((u64
)val
<< 32);
210 static void kvmppc_write_bat(struct kvm_vcpu
*vcpu
, int sprn
, u32 val
)
212 struct kvmppc_vcpu_book3s
*vcpu_book3s
= to_book3s(vcpu
);
213 struct kvmppc_bat
*bat
;
216 case SPRN_IBAT0U
... SPRN_IBAT3L
:
217 bat
= &vcpu_book3s
->ibat
[(sprn
- SPRN_IBAT0U
) / 2];
219 case SPRN_IBAT4U
... SPRN_IBAT7L
:
220 bat
= &vcpu_book3s
->ibat
[(sprn
- SPRN_IBAT4U
) / 2];
222 case SPRN_DBAT0U
... SPRN_DBAT3L
:
223 bat
= &vcpu_book3s
->dbat
[(sprn
- SPRN_DBAT0U
) / 2];
225 case SPRN_DBAT4U
... SPRN_DBAT7L
:
226 bat
= &vcpu_book3s
->dbat
[(sprn
- SPRN_DBAT4U
) / 2];
232 kvmppc_set_bat(vcpu
, bat
, !(sprn
% 2), val
);
235 int kvmppc_core_emulate_mtspr(struct kvm_vcpu
*vcpu
, int sprn
, int rs
)
237 int emulated
= EMULATE_DONE
;
238 ulong spr_val
= kvmppc_get_gpr(vcpu
, rs
);
242 to_book3s(vcpu
)->sdr1
= spr_val
;
245 to_book3s(vcpu
)->dsisr
= spr_val
;
248 vcpu
->arch
.dear
= spr_val
;
251 to_book3s(vcpu
)->hior
= spr_val
;
253 case SPRN_IBAT0U
... SPRN_IBAT3L
:
254 case SPRN_IBAT4U
... SPRN_IBAT7L
:
255 case SPRN_DBAT0U
... SPRN_DBAT3L
:
256 case SPRN_DBAT4U
... SPRN_DBAT7L
:
257 kvmppc_write_bat(vcpu
, sprn
, (u32
)spr_val
);
258 /* BAT writes happen so rarely that we're ok to flush
260 kvmppc_mmu_pte_flush(vcpu
, 0, 0);
263 to_book3s(vcpu
)->hid
[0] = spr_val
;
266 to_book3s(vcpu
)->hid
[1] = spr_val
;
269 to_book3s(vcpu
)->hid
[2] = spr_val
;
272 to_book3s(vcpu
)->hid
[4] = spr_val
;
275 to_book3s(vcpu
)->hid
[5] = spr_val
;
276 /* guest HID5 set can change is_dcbz32 */
277 if (vcpu
->arch
.mmu
.is_dcbz32(vcpu
) &&
279 vcpu
->arch
.hflags
|= BOOK3S_HFLAG_DCBZ32
;
289 printk(KERN_INFO
"KVM: invalid SPR write: %d\n", sprn
);
291 emulated
= EMULATE_FAIL
;
299 int kvmppc_core_emulate_mfspr(struct kvm_vcpu
*vcpu
, int sprn
, int rt
)
301 int emulated
= EMULATE_DONE
;
305 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->sdr1
);
308 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->dsisr
);
311 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.dear
);
314 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hior
);
317 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hid
[0]);
320 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hid
[1]);
323 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hid
[2]);
326 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hid
[4]);
329 kvmppc_set_gpr(vcpu
, rt
, to_book3s(vcpu
)->hid
[5]);
336 kvmppc_set_gpr(vcpu
, rt
, 0);
339 printk(KERN_INFO
"KVM: invalid SPR read: %d\n", sprn
);
341 emulated
= EMULATE_FAIL
;