2 * Copyright (C) 2008 Freescale Semiconductor, Inc. All rights reserved.
4 * Author: Yu Liu, <yu.liu@freescale.com>
7 * This file is derived from arch/powerpc/kvm/44x.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 <linux/kvm_host.h>
16 #include <linux/slab.h>
17 #include <linux/err.h>
20 #include <asm/cputable.h>
21 #include <asm/tlbflush.h>
22 #include <asm/kvm_e500.h>
23 #include <asm/kvm_ppc.h>
28 void kvmppc_core_load_host_debugstate(struct kvm_vcpu
*vcpu
)
32 void kvmppc_core_load_guest_debugstate(struct kvm_vcpu
*vcpu
)
36 void kvmppc_core_vcpu_load(struct kvm_vcpu
*vcpu
, int cpu
)
38 kvmppc_e500_tlb_load(vcpu
, cpu
);
41 void kvmppc_core_vcpu_put(struct kvm_vcpu
*vcpu
)
43 kvmppc_e500_tlb_put(vcpu
);
46 int kvmppc_core_check_processor_compat(void)
50 if (strcmp(cur_cpu_spec
->cpu_name
, "e500v2") == 0)
58 int kvmppc_core_vcpu_setup(struct kvm_vcpu
*vcpu
)
60 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
62 kvmppc_e500_tlb_setup(vcpu_e500
);
65 vcpu
->arch
.pvr
= mfspr(SPRN_PVR
);
66 vcpu_e500
->svr
= mfspr(SPRN_SVR
);
68 /* Since booke kvm only support one core, update all vcpus' PIR to 0 */
74 /* 'linear_address' is actually an encoding of AS|PID|EADDR . */
75 int kvmppc_core_vcpu_translate(struct kvm_vcpu
*vcpu
,
76 struct kvm_translation
*tr
)
83 eaddr
= tr
->linear_address
;
84 pid
= (tr
->linear_address
>> 32) & 0xff;
85 as
= (tr
->linear_address
>> 40) & 0x1;
87 index
= kvmppc_e500_tlb_search(vcpu
, eaddr
, pid
, as
);
93 tr
->physical_address
= kvmppc_mmu_xlate(vcpu
, index
, eaddr
);
94 /* XXX what does "writeable" and "usermode" even mean? */
100 void kvmppc_core_get_sregs(struct kvm_vcpu
*vcpu
, struct kvm_sregs
*sregs
)
102 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
104 sregs
->u
.e
.features
|= KVM_SREGS_E_ARCH206_MMU
| KVM_SREGS_E_SPE
|
106 sregs
->u
.e
.impl_id
= KVM_SREGS_E_IMPL_FSL
;
108 sregs
->u
.e
.impl
.fsl
.features
= 0;
109 sregs
->u
.e
.impl
.fsl
.svr
= vcpu_e500
->svr
;
110 sregs
->u
.e
.impl
.fsl
.hid0
= vcpu_e500
->hid0
;
111 sregs
->u
.e
.impl
.fsl
.mcar
= vcpu_e500
->mcar
;
113 sregs
->u
.e
.mas0
= vcpu_e500
->mas0
;
114 sregs
->u
.e
.mas1
= vcpu_e500
->mas1
;
115 sregs
->u
.e
.mas2
= vcpu_e500
->mas2
;
116 sregs
->u
.e
.mas7_3
= ((u64
)vcpu_e500
->mas7
<< 32) | vcpu_e500
->mas3
;
117 sregs
->u
.e
.mas4
= vcpu_e500
->mas4
;
118 sregs
->u
.e
.mas6
= vcpu_e500
->mas6
;
120 sregs
->u
.e
.mmucfg
= mfspr(SPRN_MMUCFG
);
121 sregs
->u
.e
.tlbcfg
[0] = vcpu_e500
->tlb0cfg
;
122 sregs
->u
.e
.tlbcfg
[1] = vcpu_e500
->tlb1cfg
;
123 sregs
->u
.e
.tlbcfg
[2] = 0;
124 sregs
->u
.e
.tlbcfg
[3] = 0;
126 sregs
->u
.e
.ivor_high
[0] = vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_UNAVAIL
];
127 sregs
->u
.e
.ivor_high
[1] = vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_DATA
];
128 sregs
->u
.e
.ivor_high
[2] = vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_ROUND
];
129 sregs
->u
.e
.ivor_high
[3] =
130 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_PERFORMANCE_MONITOR
];
132 kvmppc_get_sregs_ivor(vcpu
, sregs
);
135 int kvmppc_core_set_sregs(struct kvm_vcpu
*vcpu
, struct kvm_sregs
*sregs
)
137 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
139 if (sregs
->u
.e
.impl_id
== KVM_SREGS_E_IMPL_FSL
) {
140 vcpu_e500
->svr
= sregs
->u
.e
.impl
.fsl
.svr
;
141 vcpu_e500
->hid0
= sregs
->u
.e
.impl
.fsl
.hid0
;
142 vcpu_e500
->mcar
= sregs
->u
.e
.impl
.fsl
.mcar
;
145 if (sregs
->u
.e
.features
& KVM_SREGS_E_ARCH206_MMU
) {
146 vcpu_e500
->mas0
= sregs
->u
.e
.mas0
;
147 vcpu_e500
->mas1
= sregs
->u
.e
.mas1
;
148 vcpu_e500
->mas2
= sregs
->u
.e
.mas2
;
149 vcpu_e500
->mas7
= sregs
->u
.e
.mas7_3
>> 32;
150 vcpu_e500
->mas3
= (u32
)sregs
->u
.e
.mas7_3
;
151 vcpu_e500
->mas4
= sregs
->u
.e
.mas4
;
152 vcpu_e500
->mas6
= sregs
->u
.e
.mas6
;
155 if (!(sregs
->u
.e
.features
& KVM_SREGS_E_IVOR
))
158 if (sregs
->u
.e
.features
& KVM_SREGS_E_SPE
) {
159 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_UNAVAIL
] =
160 sregs
->u
.e
.ivor_high
[0];
161 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_DATA
] =
162 sregs
->u
.e
.ivor_high
[1];
163 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_SPE_FP_ROUND
] =
164 sregs
->u
.e
.ivor_high
[2];
167 if (sregs
->u
.e
.features
& KVM_SREGS_E_PM
) {
168 vcpu
->arch
.ivor
[BOOKE_IRQPRIO_PERFORMANCE_MONITOR
] =
169 sregs
->u
.e
.ivor_high
[3];
172 return kvmppc_set_sregs_ivor(vcpu
, sregs
);
175 struct kvm_vcpu
*kvmppc_core_vcpu_create(struct kvm
*kvm
, unsigned int id
)
177 struct kvmppc_vcpu_e500
*vcpu_e500
;
178 struct kvm_vcpu
*vcpu
;
181 vcpu_e500
= kmem_cache_zalloc(kvm_vcpu_cache
, GFP_KERNEL
);
187 vcpu
= &vcpu_e500
->vcpu
;
188 err
= kvm_vcpu_init(vcpu
, kvm
, id
);
192 err
= kvmppc_e500_tlb_init(vcpu_e500
);
196 vcpu
->arch
.shared
= (void*)__get_free_page(GFP_KERNEL
|__GFP_ZERO
);
197 if (!vcpu
->arch
.shared
)
203 kvmppc_e500_tlb_uninit(vcpu_e500
);
205 kvm_vcpu_uninit(vcpu
);
207 kmem_cache_free(kvm_vcpu_cache
, vcpu_e500
);
212 void kvmppc_core_vcpu_free(struct kvm_vcpu
*vcpu
)
214 struct kvmppc_vcpu_e500
*vcpu_e500
= to_e500(vcpu
);
216 free_page((unsigned long)vcpu
->arch
.shared
);
217 kvm_vcpu_uninit(vcpu
);
218 kvmppc_e500_tlb_uninit(vcpu_e500
);
219 kmem_cache_free(kvm_vcpu_cache
, vcpu_e500
);
222 static int __init
kvmppc_e500_init(void)
225 unsigned long ivor
[3];
226 unsigned long max_ivor
= 0;
228 r
= kvmppc_booke_init();
232 /* copy extra E500 exception handlers */
233 ivor
[0] = mfspr(SPRN_IVOR32
);
234 ivor
[1] = mfspr(SPRN_IVOR33
);
235 ivor
[2] = mfspr(SPRN_IVOR34
);
236 for (i
= 0; i
< 3; i
++) {
237 if (ivor
[i
] > max_ivor
)
240 memcpy((void *)kvmppc_booke_handlers
+ ivor
[i
],
241 kvmppc_handlers_start
+ (i
+ 16) * kvmppc_handler_len
,
244 flush_icache_range(kvmppc_booke_handlers
,
245 kvmppc_booke_handlers
+ max_ivor
+ kvmppc_handler_len
);
247 return kvm_init(NULL
, sizeof(struct kvmppc_vcpu_e500
), 0, THIS_MODULE
);
250 static void __exit
kvmppc_e500_exit(void)
255 module_init(kvmppc_e500_init
);
256 module_exit(kvmppc_e500_exit
);