]>
Commit | Line | Data |
---|---|---|
bc8080cb | 1 | /* |
5ce941ee | 2 | * Copyright (C) 2008-2011 Freescale Semiconductor, Inc. All rights reserved. |
bc8080cb HB |
3 | * |
4 | * Author: Yu Liu, <yu.liu@freescale.com> | |
5 | * | |
6 | * Description: | |
7 | * This file is derived from arch/powerpc/kvm/44x_emulate.c, | |
8 | * by Hollis Blanchard <hollisb@us.ibm.com>. | |
9 | * | |
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. | |
13 | */ | |
14 | ||
15 | #include <asm/kvm_ppc.h> | |
16 | #include <asm/disassemble.h> | |
17 | #include <asm/kvm_e500.h> | |
18 | ||
19 | #include "booke.h" | |
20 | #include "e500_tlb.h" | |
21 | ||
22 | #define XOP_TLBIVAX 786 | |
23 | #define XOP_TLBSX 914 | |
24 | #define XOP_TLBRE 946 | |
25 | #define XOP_TLBWE 978 | |
26 | ||
27 | int kvmppc_core_emulate_op(struct kvm_run *run, struct kvm_vcpu *vcpu, | |
28 | unsigned int inst, int *advance) | |
29 | { | |
30 | int emulated = EMULATE_DONE; | |
31 | int ra; | |
32 | int rb; | |
bc8080cb HB |
33 | |
34 | switch (get_op(inst)) { | |
35 | case 31: | |
36 | switch (get_xop(inst)) { | |
37 | ||
38 | case XOP_TLBRE: | |
39 | emulated = kvmppc_e500_emul_tlbre(vcpu); | |
40 | break; | |
41 | ||
42 | case XOP_TLBWE: | |
43 | emulated = kvmppc_e500_emul_tlbwe(vcpu); | |
44 | break; | |
45 | ||
46 | case XOP_TLBSX: | |
47 | rb = get_rb(inst); | |
48 | emulated = kvmppc_e500_emul_tlbsx(vcpu,rb); | |
49 | break; | |
50 | ||
51 | case XOP_TLBIVAX: | |
52 | ra = get_ra(inst); | |
53 | rb = get_rb(inst); | |
54 | emulated = kvmppc_e500_emul_tlbivax(vcpu, ra, rb); | |
55 | break; | |
56 | ||
57 | default: | |
58 | emulated = EMULATE_FAIL; | |
59 | } | |
60 | ||
61 | break; | |
62 | ||
63 | default: | |
64 | emulated = EMULATE_FAIL; | |
65 | } | |
66 | ||
67 | if (emulated == EMULATE_FAIL) | |
68 | emulated = kvmppc_booke_emulate_op(run, vcpu, inst, advance); | |
69 | ||
70 | return emulated; | |
71 | } | |
72 | ||
73 | int kvmppc_core_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, int rs) | |
74 | { | |
75 | struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); | |
76 | int emulated = EMULATE_DONE; | |
8e5b26b5 | 77 | ulong spr_val = kvmppc_get_gpr(vcpu, rs); |
bc8080cb HB |
78 | |
79 | switch (sprn) { | |
80 | case SPRN_PID: | |
5ce941ee | 81 | kvmppc_set_pid(vcpu, spr_val); |
bc8080cb HB |
82 | break; |
83 | case SPRN_PID1: | |
dd9ebf1f LY |
84 | if (spr_val != 0) |
85 | return EMULATE_FAIL; | |
8e5b26b5 | 86 | vcpu_e500->pid[1] = spr_val; break; |
bc8080cb | 87 | case SPRN_PID2: |
dd9ebf1f LY |
88 | if (spr_val != 0) |
89 | return EMULATE_FAIL; | |
8e5b26b5 | 90 | vcpu_e500->pid[2] = spr_val; break; |
bc8080cb | 91 | case SPRN_MAS0: |
8e5b26b5 | 92 | vcpu_e500->mas0 = spr_val; break; |
bc8080cb | 93 | case SPRN_MAS1: |
8e5b26b5 | 94 | vcpu_e500->mas1 = spr_val; break; |
bc8080cb | 95 | case SPRN_MAS2: |
8e5b26b5 | 96 | vcpu_e500->mas2 = spr_val; break; |
bc8080cb | 97 | case SPRN_MAS3: |
dc83b8bc SW |
98 | vcpu_e500->mas7_3 &= ~(u64)0xffffffff; |
99 | vcpu_e500->mas7_3 |= spr_val; | |
100 | break; | |
bc8080cb | 101 | case SPRN_MAS4: |
8e5b26b5 | 102 | vcpu_e500->mas4 = spr_val; break; |
bc8080cb | 103 | case SPRN_MAS6: |
8e5b26b5 | 104 | vcpu_e500->mas6 = spr_val; break; |
bc8080cb | 105 | case SPRN_MAS7: |
dc83b8bc SW |
106 | vcpu_e500->mas7_3 &= (u64)0xffffffff; |
107 | vcpu_e500->mas7_3 |= (u64)spr_val << 32; | |
108 | break; | |
d86be077 LY |
109 | case SPRN_L1CSR0: |
110 | vcpu_e500->l1csr0 = spr_val; | |
111 | vcpu_e500->l1csr0 &= ~(L1CSR0_DCFI | L1CSR0_CLFC); | |
112 | break; | |
bc8080cb | 113 | case SPRN_L1CSR1: |
8e5b26b5 | 114 | vcpu_e500->l1csr1 = spr_val; break; |
bc8080cb | 115 | case SPRN_HID0: |
8e5b26b5 | 116 | vcpu_e500->hid0 = spr_val; break; |
bc8080cb | 117 | case SPRN_HID1: |
8e5b26b5 | 118 | vcpu_e500->hid1 = spr_val; break; |
bc8080cb | 119 | |
b0a1835d LY |
120 | case SPRN_MMUCSR0: |
121 | emulated = kvmppc_e500_emul_mt_mmucsr0(vcpu_e500, | |
8e5b26b5 | 122 | spr_val); |
b0a1835d LY |
123 | break; |
124 | ||
bb3a8a17 HB |
125 | /* extra exceptions */ |
126 | case SPRN_IVOR32: | |
8e5b26b5 | 127 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL] = spr_val; |
bb3a8a17 HB |
128 | break; |
129 | case SPRN_IVOR33: | |
8e5b26b5 | 130 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA] = spr_val; |
bb3a8a17 HB |
131 | break; |
132 | case SPRN_IVOR34: | |
8e5b26b5 | 133 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND] = spr_val; |
bb3a8a17 HB |
134 | break; |
135 | case SPRN_IVOR35: | |
8e5b26b5 | 136 | vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR] = spr_val; |
bb3a8a17 HB |
137 | break; |
138 | ||
bc8080cb HB |
139 | default: |
140 | emulated = kvmppc_booke_emulate_mtspr(vcpu, sprn, rs); | |
141 | } | |
142 | ||
143 | return emulated; | |
144 | } | |
145 | ||
146 | int kvmppc_core_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt) | |
147 | { | |
148 | struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); | |
149 | int emulated = EMULATE_DONE; | |
150 | ||
151 | switch (sprn) { | |
152 | case SPRN_PID: | |
8e5b26b5 | 153 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[0]); break; |
bc8080cb | 154 | case SPRN_PID1: |
8e5b26b5 | 155 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[1]); break; |
bc8080cb | 156 | case SPRN_PID2: |
8e5b26b5 | 157 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[2]); break; |
bc8080cb | 158 | case SPRN_MAS0: |
8e5b26b5 | 159 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas0); break; |
bc8080cb | 160 | case SPRN_MAS1: |
8e5b26b5 | 161 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas1); break; |
bc8080cb | 162 | case SPRN_MAS2: |
8e5b26b5 | 163 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas2); break; |
bc8080cb | 164 | case SPRN_MAS3: |
dc83b8bc | 165 | kvmppc_set_gpr(vcpu, rt, (u32)vcpu_e500->mas7_3); break; |
bc8080cb | 166 | case SPRN_MAS4: |
8e5b26b5 | 167 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas4); break; |
bc8080cb | 168 | case SPRN_MAS6: |
8e5b26b5 | 169 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas6); break; |
bc8080cb | 170 | case SPRN_MAS7: |
dc83b8bc | 171 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas7_3 >> 32); break; |
bc8080cb HB |
172 | |
173 | case SPRN_TLB0CFG: | |
da15bf43 | 174 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb0cfg); break; |
bc8080cb | 175 | case SPRN_TLB1CFG: |
da15bf43 | 176 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb1cfg); break; |
d86be077 LY |
177 | case SPRN_L1CSR0: |
178 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr0); break; | |
bc8080cb | 179 | case SPRN_L1CSR1: |
8e5b26b5 | 180 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr1); break; |
bc8080cb | 181 | case SPRN_HID0: |
8e5b26b5 | 182 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid0); break; |
bc8080cb | 183 | case SPRN_HID1: |
8e5b26b5 | 184 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid1); break; |
90d34b0e SW |
185 | case SPRN_SVR: |
186 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->svr); break; | |
bc8080cb | 187 | |
b0a1835d | 188 | case SPRN_MMUCSR0: |
8e5b26b5 | 189 | kvmppc_set_gpr(vcpu, rt, 0); break; |
b0a1835d | 190 | |
06579dd9 | 191 | case SPRN_MMUCFG: |
8e5b26b5 | 192 | kvmppc_set_gpr(vcpu, rt, mfspr(SPRN_MMUCFG)); break; |
06579dd9 | 193 | |
bb3a8a17 HB |
194 | /* extra exceptions */ |
195 | case SPRN_IVOR32: | |
8e5b26b5 | 196 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL]); |
bb3a8a17 HB |
197 | break; |
198 | case SPRN_IVOR33: | |
8e5b26b5 | 199 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA]); |
bb3a8a17 HB |
200 | break; |
201 | case SPRN_IVOR34: | |
8e5b26b5 | 202 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND]); |
bb3a8a17 HB |
203 | break; |
204 | case SPRN_IVOR35: | |
8e5b26b5 | 205 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR]); |
bb3a8a17 | 206 | break; |
bc8080cb HB |
207 | default: |
208 | emulated = kvmppc_booke_emulate_mfspr(vcpu, sprn, rt); | |
209 | } | |
210 | ||
211 | return emulated; | |
212 | } | |
213 |