2 * Copyright (C) 2008-2011 Freescale Semiconductor, Inc. All rights reserved.
4 * Author: Yu Liu, <yu.liu@freescale.com>
7 * This file is derived from arch/powerpc/kvm/44x_emulate.c,
8 * by Hollis Blanchard <hollisb@us.ibm.com>.
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License, version 2, as
12 * published by the Free Software Foundation.
15 #include <asm/kvm_ppc.h>
16 #include <asm/disassemble.h>
17 #include <asm/dbell.h>
22 #define XOP_MSGSND 206
23 #define XOP_MSGCLR 238
24 #define XOP_TLBIVAX 786
30 #ifdef CONFIG_KVM_E500MC
31 static int dbell2prio(ulong param
)
33 int msg
= param
& PPC_DBELL_TYPE_MASK
;
37 case PPC_DBELL_TYPE(PPC_DBELL
):
38 prio
= BOOKE_IRQPRIO_DBELL
;
40 case PPC_DBELL_TYPE(PPC_DBELL_CRIT
):
41 prio
= BOOKE_IRQPRIO_DBELL_CRIT
;
50 static int kvmppc_e500_emul_msgclr(struct kvm_vcpu
*vcpu
, int rb
)
52 ulong param
= vcpu
->arch
.gpr
[rb
];
53 int prio
= dbell2prio(param
);
58 clear_bit(prio
, &vcpu
->arch
.pending_exceptions
);
62 static int kvmppc_e500_emul_msgsnd(struct kvm_vcpu
*vcpu
, int rb
)
64 ulong param
= vcpu
->arch
.gpr
[rb
];
65 int prio
= dbell2prio(rb
);
66 int pir
= param
& PPC_DBELL_PIR_MASK
;
68 struct kvm_vcpu
*cvcpu
;
73 kvm_for_each_vcpu(i
, cvcpu
, vcpu
->kvm
) {
74 int cpir
= cvcpu
->arch
.shared
->pir
;
75 if ((param
& PPC_DBELL_MSG_BRDCAST
) || (cpir
== pir
)) {
76 set_bit(prio
, &cvcpu
->arch
.pending_exceptions
);
85 int kvmppc_core_emulate_op(struct kvm_run
*run
, struct kvm_vcpu
*vcpu
,
86 unsigned int inst
, int *advance
)
88 int emulated
= EMULATE_DONE
;
93 switch (get_op(inst
)) {
95 switch (get_xop(inst
)) {
97 #ifdef CONFIG_KVM_E500MC
99 emulated
= kvmppc_e500_emul_msgsnd(vcpu
, get_rb(inst
));
103 emulated
= kvmppc_e500_emul_msgclr(vcpu
, get_rb(inst
));
108 emulated
= kvmppc_e500_emul_tlbre(vcpu
);
112 emulated
= kvmppc_e500_emul_tlbwe(vcpu
);
117 emulated
= kvmppc_e500_emul_tlbsx(vcpu
,rb
);
124 emulated
= kvmppc_e500_emul_tlbilx(vcpu
, rt
, ra
, rb
);
130 emulated
= kvmppc_e500_emul_tlbivax(vcpu
, ra
, rb
);
134 emulated
= EMULATE_FAIL
;
140 emulated
= EMULATE_FAIL
;
143 if (emulated
== EMULATE_FAIL
)
144 emulated
= kvmppc_booke_emulate_op(run
, vcpu
, inst
, advance
);
149 int kvmppc_core_emulate_mtspr(struct kvm_vcpu
*vcpu
, int sprn
, int rs
)
151 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
152 int emulated
= EMULATE_DONE
;
153 ulong spr_val
= kvmppc_get_gpr(vcpu
, rs
);
156 #ifndef CONFIG_KVM_BOOKE_HV
158 kvmppc_set_pid(vcpu
, spr_val
);
163 vcpu_e500
->pid
[1] = spr_val
; break;
167 vcpu_e500
->pid
[2] = spr_val
; break;
169 vcpu
->arch
.shared
->mas0
= spr_val
; break;
171 vcpu
->arch
.shared
->mas1
= spr_val
; break;
173 vcpu
->arch
.shared
->mas2
= spr_val
; break;
175 vcpu
->arch
.shared
->mas7_3
&= ~(u64
)0xffffffff;
176 vcpu
->arch
.shared
->mas7_3
|= spr_val
;
179 vcpu
->arch
.shared
->mas4
= spr_val
; break;
181 vcpu
->arch
.shared
->mas6
= spr_val
; break;
183 vcpu
->arch
.shared
->mas7_3
&= (u64
)0xffffffff;
184 vcpu
->arch
.shared
->mas7_3
|= (u64
)spr_val
<< 32;
188 vcpu_e500
->l1csr0
= spr_val
;
189 vcpu_e500
->l1csr0
&= ~(L1CSR0_DCFI
| L1CSR0_CLFC
);
192 vcpu_e500
->l1csr1
= spr_val
; break;
194 vcpu_e500
->hid0
= spr_val
; break;
196 vcpu_e500
->hid1
= spr_val
; break;
199 emulated
= kvmppc_e500_emul_mt_mmucsr0(vcpu_e500
,
203 /* extra exceptions */
205 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_UNAVAIL
] = spr_val
;
208 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_DATA
] = spr_val
;
211 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_ROUND
] = spr_val
;
214 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_PERFORMANCE_MONITOR
] = spr_val
;
216 #ifdef CONFIG_KVM_BOOKE_HV
218 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_DBELL
] = spr_val
;
221 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_DBELL_CRIT
] = spr_val
;
225 emulated
= kvmppc_booke_emulate_mtspr(vcpu
, sprn
, rs
);
231 int kvmppc_core_emulate_mfspr(struct kvm_vcpu
*vcpu
, int sprn
, int rt
)
233 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
234 int emulated
= EMULATE_DONE
;
237 #ifndef CONFIG_KVM_BOOKE_HV
241 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->pid
[0]); break;
243 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->pid
[1]); break;
245 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->pid
[2]); break;
247 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.shared
->mas0
); break;
249 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.shared
->mas1
); break;
251 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.shared
->mas2
); break;
253 val
= (u32
)vcpu
->arch
.shared
->mas7_3
;
254 kvmppc_set_gpr(vcpu
, rt
, val
);
257 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.shared
->mas4
); break;
259 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.shared
->mas6
); break;
261 val
= vcpu
->arch
.shared
->mas7_3
>> 32;
262 kvmppc_set_gpr(vcpu
, rt
, val
);
266 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.tlbcfg
[0]); break;
268 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.tlbcfg
[1]); break;
270 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->l1csr0
); break;
272 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->l1csr1
); break;
274 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->hid0
); break;
276 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->hid1
); break;
278 kvmppc_set_gpr(vcpu
, rt
, vcpu_e500
->svr
); break;
281 kvmppc_set_gpr(vcpu
, rt
, 0); break;
284 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.mmucfg
); break;
286 /* extra exceptions */
288 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_UNAVAIL
]);
291 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_DATA
]);
294 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_ROUND
]);
297 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_PERFORMANCE_MONITOR
]);
299 #ifdef CONFIG_KVM_BOOKE_HV
301 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_DBELL
]);
304 kvmppc_set_gpr(vcpu
, rt
, vcpu
->arch
.ivor
[BOOKE_IRQPRIO_DBELL_CRIT
]);
308 emulated
= kvmppc_booke_emulate_mfspr(vcpu
, sprn
, rt
);