1 /* 2 * Copyright (C) 2008 Freescale Semiconductor, Inc. All rights reserved. 3 * 4 * Author: Yu Liu, <yu.liu@freescale.com> 5 * 6 * Description: 7 * This file is derived from arch/powerpc/kvm/44x.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 <linux/kvm_host.h> 16 #include <linux/err.h> 17 18 #include <asm/reg.h> 19 #include <asm/cputable.h> 20 #include <asm/tlbflush.h> 21 #include <asm/kvm_e500.h> 22 #include <asm/kvm_ppc.h> 23 24 #include "booke.h" 25 #include "e500_tlb.h" 26 27 void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu) 28 { 29 } 30 31 void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu) 32 { 33 } 34 35 void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu) 36 { 37 kvmppc_e500_tlb_load(vcpu, cpu); 38 } 39 40 void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu) 41 { 42 kvmppc_e500_tlb_put(vcpu); 43 } 44 45 int kvmppc_core_check_processor_compat(void) 46 { 47 int r; 48 49 if (strcmp(cur_cpu_spec->cpu_name, "e500v2") == 0) 50 r = 0; 51 else 52 r = -ENOTSUPP; 53 54 return r; 55 } 56 57 int kvmppc_core_vcpu_setup(struct kvm_vcpu *vcpu) 58 { 59 struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); 60 61 kvmppc_e500_tlb_setup(vcpu_e500); 62 63 return 0; 64 } 65 66 /* 'linear_address' is actually an encoding of AS|PID|EADDR . */ 67 int kvmppc_core_vcpu_translate(struct kvm_vcpu *vcpu, 68 struct kvm_translation *tr) 69 { 70 int index; 71 gva_t eaddr; 72 u8 pid; 73 u8 as; 74 75 eaddr = tr->linear_address; 76 pid = (tr->linear_address >> 32) & 0xff; 77 as = (tr->linear_address >> 40) & 0x1; 78 79 index = kvmppc_e500_tlb_search(vcpu, eaddr, pid, as); 80 if (index < 0) { 81 tr->valid = 0; 82 return 0; 83 } 84 85 tr->physical_address = kvmppc_mmu_xlate(vcpu, index, eaddr); 86 /* XXX what does "writeable" and "usermode" even mean? */ 87 tr->valid = 1; 88 89 return 0; 90 } 91 92 struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id) 93 { 94 struct kvmppc_vcpu_e500 *vcpu_e500; 95 struct kvm_vcpu *vcpu; 96 int err; 97 98 vcpu_e500 = kmem_cache_zalloc(kvm_vcpu_cache, GFP_KERNEL); 99 if (!vcpu_e500) { 100 err = -ENOMEM; 101 goto out; 102 } 103 104 vcpu = &vcpu_e500->vcpu; 105 err = kvm_vcpu_init(vcpu, kvm, id); 106 if (err) 107 goto free_vcpu; 108 109 err = kvmppc_e500_tlb_init(vcpu_e500); 110 if (err) 111 goto uninit_vcpu; 112 113 return vcpu; 114 115 uninit_vcpu: 116 kvm_vcpu_uninit(vcpu); 117 free_vcpu: 118 kmem_cache_free(kvm_vcpu_cache, vcpu_e500); 119 out: 120 return ERR_PTR(err); 121 } 122 123 void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu) 124 { 125 struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); 126 127 kvmppc_e500_tlb_uninit(vcpu_e500); 128 kvm_vcpu_uninit(vcpu); 129 kmem_cache_free(kvm_vcpu_cache, vcpu_e500); 130 } 131 132 static int __init kvmppc_e500_init(void) 133 { 134 int r, i; 135 unsigned long ivor[3]; 136 unsigned long max_ivor = 0; 137 138 r = kvmppc_booke_init(); 139 if (r) 140 return r; 141 142 /* copy extra E500 exception handlers */ 143 ivor[0] = mfspr(SPRN_IVOR32); 144 ivor[1] = mfspr(SPRN_IVOR33); 145 ivor[2] = mfspr(SPRN_IVOR34); 146 for (i = 0; i < 3; i++) { 147 if (ivor[i] > max_ivor) 148 max_ivor = ivor[i]; 149 150 memcpy((void *)kvmppc_booke_handlers + ivor[i], 151 kvmppc_handlers_start + (i + 16) * kvmppc_handler_len, 152 kvmppc_handler_len); 153 } 154 flush_icache_range(kvmppc_booke_handlers, 155 kvmppc_booke_handlers + max_ivor + kvmppc_handler_len); 156 157 return kvm_init(NULL, sizeof(struct kvmppc_vcpu_e500), THIS_MODULE); 158 } 159 160 static void __init kvmppc_e500_exit(void) 161 { 162 kvmppc_booke_exit(); 163 } 164 165 module_init(kvmppc_e500_init); 166 module_exit(kvmppc_e500_exit); 167