Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 1 | /* |
| 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. |
| 5 | * |
| 6 | * Copyright 2010-2011 Paul Mackerras, IBM Corp. <paulus@au1.ibm.com> |
| 7 | */ |
| 8 | |
| 9 | #include <linux/types.h> |
| 10 | #include <linux/string.h> |
| 11 | #include <linux/kvm.h> |
| 12 | #include <linux/kvm_host.h> |
| 13 | #include <linux/hugetlb.h> |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 14 | #include <linux/module.h> |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 15 | |
| 16 | #include <asm/tlbflush.h> |
| 17 | #include <asm/kvm_ppc.h> |
| 18 | #include <asm/kvm_book3s.h> |
| 19 | #include <asm/mmu-hash64.h> |
| 20 | #include <asm/hvcall.h> |
| 21 | #include <asm/synch.h> |
| 22 | #include <asm/ppc-opcode.h> |
| 23 | |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 24 | /* |
| 25 | * Since this file is built in even if KVM is a module, we need |
| 26 | * a local copy of this function for the case where kvm_main.c is |
| 27 | * modular. |
| 28 | */ |
| 29 | static struct kvm_memory_slot *builtin_gfn_to_memslot(struct kvm *kvm, |
| 30 | gfn_t gfn) |
| 31 | { |
| 32 | struct kvm_memslots *slots; |
| 33 | struct kvm_memory_slot *memslot; |
| 34 | |
| 35 | slots = kvm_memslots(kvm); |
| 36 | kvm_for_each_memslot(memslot, slots) |
| 37 | if (gfn >= memslot->base_gfn && |
| 38 | gfn < memslot->base_gfn + memslot->npages) |
| 39 | return memslot; |
| 40 | return NULL; |
| 41 | } |
| 42 | |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 43 | /* Translate address of a vmalloc'd thing to a linear map address */ |
| 44 | static void *real_vmalloc_addr(void *x) |
| 45 | { |
| 46 | unsigned long addr = (unsigned long) x; |
| 47 | pte_t *p; |
| 48 | |
| 49 | p = find_linux_pte(swapper_pg_dir, addr); |
| 50 | if (!p || !pte_present(*p)) |
| 51 | return NULL; |
| 52 | /* assume we don't have huge pages in vmalloc space... */ |
| 53 | addr = (pte_pfn(*p) << PAGE_SHIFT) | (addr & ~PAGE_MASK); |
| 54 | return __va(addr); |
| 55 | } |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 56 | |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 57 | long kvmppc_h_enter(struct kvm_vcpu *vcpu, unsigned long flags, |
| 58 | long pte_index, unsigned long pteh, unsigned long ptel) |
| 59 | { |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 60 | struct kvm *kvm = vcpu->kvm; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 61 | unsigned long i, pa, gpa, gfn, psize; |
| 62 | unsigned long slot_fn; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 63 | unsigned long *hpte; |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 64 | struct revmap_entry *rev; |
| 65 | unsigned long g_ptel = ptel; |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 66 | struct kvm_memory_slot *memslot; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 67 | unsigned long *physp, pte_size; |
Paul Mackerras | 9d0ef5ea | 2011-12-12 12:32:27 +0000 | [diff] [blame^] | 68 | unsigned long is_io; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 69 | bool realmode = vcpu->arch.vcore->vcore_state == VCORE_RUNNING; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 70 | |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 71 | psize = hpte_page_size(pteh, ptel); |
| 72 | if (!psize) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 73 | return H_PARAMETER; |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 74 | |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 75 | /* Find the memslot (if any) for this address */ |
| 76 | gpa = (ptel & HPTE_R_RPN) & ~(psize - 1); |
| 77 | gfn = gpa >> PAGE_SHIFT; |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 78 | memslot = builtin_gfn_to_memslot(kvm, gfn); |
| 79 | if (!(memslot && !(memslot->flags & KVM_MEMSLOT_INVALID))) |
| 80 | return H_PARAMETER; |
Paul Mackerras | da9d1d7 | 2011-12-12 12:31:41 +0000 | [diff] [blame] | 81 | |
| 82 | /* Check if the requested page fits entirely in the memslot. */ |
| 83 | if (!slot_is_aligned(memslot, psize)) |
| 84 | return H_PARAMETER; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 85 | slot_fn = gfn - memslot->base_gfn; |
| 86 | |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 87 | physp = kvm->arch.slot_phys[memslot->id]; |
| 88 | if (!physp) |
| 89 | return H_PARAMETER; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 90 | physp += slot_fn; |
| 91 | if (realmode) |
| 92 | physp = real_vmalloc_addr(physp); |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 93 | pa = *physp; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 94 | if (!pa) |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 95 | return H_TOO_HARD; |
Paul Mackerras | 9d0ef5ea | 2011-12-12 12:32:27 +0000 | [diff] [blame^] | 96 | is_io = pa & (HPTE_R_I | HPTE_R_W); |
Paul Mackerras | da9d1d7 | 2011-12-12 12:31:41 +0000 | [diff] [blame] | 97 | pte_size = PAGE_SIZE << (pa & KVMPPC_PAGE_ORDER_MASK); |
Paul Mackerras | b2b2f16 | 2011-12-12 12:28:21 +0000 | [diff] [blame] | 98 | pa &= PAGE_MASK; |
| 99 | |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 100 | if (pte_size < psize) |
| 101 | return H_PARAMETER; |
| 102 | if (pa && pte_size > psize) |
| 103 | pa |= gpa & (pte_size - 1); |
| 104 | |
| 105 | ptel &= ~(HPTE_R_PP0 - psize); |
| 106 | ptel |= pa; |
| 107 | |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 108 | /* Check WIMG */ |
Paul Mackerras | 9d0ef5ea | 2011-12-12 12:32:27 +0000 | [diff] [blame^] | 109 | if (!hpte_cache_flags_ok(ptel, is_io)) { |
| 110 | if (is_io) |
| 111 | return H_PARAMETER; |
| 112 | /* |
| 113 | * Allow guest to map emulated device memory as |
| 114 | * uncacheable, but actually make it cacheable. |
| 115 | */ |
| 116 | ptel &= ~(HPTE_R_W|HPTE_R_I|HPTE_R_G); |
| 117 | ptel |= HPTE_R_M; |
| 118 | } |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 119 | pteh &= ~0x60UL; |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 120 | pteh |= HPTE_V_VALID; |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 121 | |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 122 | if (pte_index >= HPT_NPTE) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 123 | return H_PARAMETER; |
| 124 | if (likely((flags & H_EXACT) == 0)) { |
| 125 | pte_index &= ~7UL; |
| 126 | hpte = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 127 | for (i = 0; i < 8; ++i) { |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 128 | if ((*hpte & HPTE_V_VALID) == 0 && |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 129 | try_lock_hpte(hpte, HPTE_V_HVLOCK | HPTE_V_VALID)) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 130 | break; |
| 131 | hpte += 2; |
| 132 | } |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 133 | if (i == 8) { |
| 134 | /* |
| 135 | * Since try_lock_hpte doesn't retry (not even stdcx. |
| 136 | * failures), it could be that there is a free slot |
| 137 | * but we transiently failed to lock it. Try again, |
| 138 | * actually locking each slot and checking it. |
| 139 | */ |
| 140 | hpte -= 16; |
| 141 | for (i = 0; i < 8; ++i) { |
| 142 | while (!try_lock_hpte(hpte, HPTE_V_HVLOCK)) |
| 143 | cpu_relax(); |
| 144 | if ((*hpte & HPTE_V_VALID) == 0) |
| 145 | break; |
| 146 | *hpte &= ~HPTE_V_HVLOCK; |
| 147 | hpte += 2; |
| 148 | } |
| 149 | if (i == 8) |
| 150 | return H_PTEG_FULL; |
| 151 | } |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 152 | pte_index += i; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 153 | } else { |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 154 | hpte = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 155 | if (!try_lock_hpte(hpte, HPTE_V_HVLOCK | HPTE_V_VALID)) { |
| 156 | /* Lock the slot and check again */ |
| 157 | while (!try_lock_hpte(hpte, HPTE_V_HVLOCK)) |
| 158 | cpu_relax(); |
| 159 | if (*hpte & HPTE_V_VALID) { |
| 160 | *hpte &= ~HPTE_V_HVLOCK; |
| 161 | return H_PTEG_FULL; |
| 162 | } |
| 163 | } |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 164 | } |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 165 | |
| 166 | /* Save away the guest's idea of the second HPTE dword */ |
| 167 | rev = real_vmalloc_addr(&kvm->arch.revmap[pte_index]); |
| 168 | if (rev) |
| 169 | rev->guest_rpte = g_ptel; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 170 | hpte[1] = ptel; |
| 171 | eieio(); |
| 172 | hpte[0] = pteh; |
| 173 | asm volatile("ptesync" : : : "memory"); |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 174 | vcpu->arch.gpr[4] = pte_index; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 175 | return H_SUCCESS; |
| 176 | } |
Paul Mackerras | c77162d | 2011-12-12 12:31:00 +0000 | [diff] [blame] | 177 | EXPORT_SYMBOL_GPL(kvmppc_h_enter); |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 178 | |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 179 | #define LOCK_TOKEN (*(u32 *)(&get_paca()->lock_token)) |
| 180 | |
| 181 | static inline int try_lock_tlbie(unsigned int *lock) |
| 182 | { |
| 183 | unsigned int tmp, old; |
| 184 | unsigned int token = LOCK_TOKEN; |
| 185 | |
| 186 | asm volatile("1:lwarx %1,0,%2\n" |
| 187 | " cmpwi cr0,%1,0\n" |
| 188 | " bne 2f\n" |
| 189 | " stwcx. %3,0,%2\n" |
| 190 | " bne- 1b\n" |
| 191 | " isync\n" |
| 192 | "2:" |
| 193 | : "=&r" (tmp), "=&r" (old) |
| 194 | : "r" (lock), "r" (token) |
| 195 | : "cc", "memory"); |
| 196 | return old == 0; |
| 197 | } |
| 198 | |
| 199 | long kvmppc_h_remove(struct kvm_vcpu *vcpu, unsigned long flags, |
| 200 | unsigned long pte_index, unsigned long avpn, |
| 201 | unsigned long va) |
| 202 | { |
| 203 | struct kvm *kvm = vcpu->kvm; |
| 204 | unsigned long *hpte; |
| 205 | unsigned long v, r, rb; |
| 206 | |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 207 | if (pte_index >= HPT_NPTE) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 208 | return H_PARAMETER; |
| 209 | hpte = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 210 | while (!try_lock_hpte(hpte, HPTE_V_HVLOCK)) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 211 | cpu_relax(); |
| 212 | if ((hpte[0] & HPTE_V_VALID) == 0 || |
| 213 | ((flags & H_AVPN) && (hpte[0] & ~0x7fUL) != avpn) || |
| 214 | ((flags & H_ANDCOND) && (hpte[0] & avpn) != 0)) { |
| 215 | hpte[0] &= ~HPTE_V_HVLOCK; |
| 216 | return H_NOT_FOUND; |
| 217 | } |
| 218 | if (atomic_read(&kvm->online_vcpus) == 1) |
| 219 | flags |= H_LOCAL; |
| 220 | vcpu->arch.gpr[4] = v = hpte[0] & ~HPTE_V_HVLOCK; |
| 221 | vcpu->arch.gpr[5] = r = hpte[1]; |
| 222 | rb = compute_tlbie_rb(v, r, pte_index); |
| 223 | hpte[0] = 0; |
| 224 | if (!(flags & H_LOCAL)) { |
| 225 | while(!try_lock_tlbie(&kvm->arch.tlbie_lock)) |
| 226 | cpu_relax(); |
| 227 | asm volatile("ptesync" : : : "memory"); |
| 228 | asm volatile(PPC_TLBIE(%1,%0)"; eieio; tlbsync" |
| 229 | : : "r" (rb), "r" (kvm->arch.lpid)); |
| 230 | asm volatile("ptesync" : : : "memory"); |
| 231 | kvm->arch.tlbie_lock = 0; |
| 232 | } else { |
| 233 | asm volatile("ptesync" : : : "memory"); |
| 234 | asm volatile("tlbiel %0" : : "r" (rb)); |
| 235 | asm volatile("ptesync" : : : "memory"); |
| 236 | } |
| 237 | return H_SUCCESS; |
| 238 | } |
| 239 | |
| 240 | long kvmppc_h_bulk_remove(struct kvm_vcpu *vcpu) |
| 241 | { |
| 242 | struct kvm *kvm = vcpu->kvm; |
| 243 | unsigned long *args = &vcpu->arch.gpr[4]; |
| 244 | unsigned long *hp, tlbrb[4]; |
| 245 | long int i, found; |
| 246 | long int n_inval = 0; |
| 247 | unsigned long flags, req, pte_index; |
| 248 | long int local = 0; |
| 249 | long int ret = H_SUCCESS; |
| 250 | |
| 251 | if (atomic_read(&kvm->online_vcpus) == 1) |
| 252 | local = 1; |
| 253 | for (i = 0; i < 4; ++i) { |
| 254 | pte_index = args[i * 2]; |
| 255 | flags = pte_index >> 56; |
| 256 | pte_index &= ((1ul << 56) - 1); |
| 257 | req = flags >> 6; |
| 258 | flags &= 3; |
| 259 | if (req == 3) |
| 260 | break; |
| 261 | if (req != 1 || flags == 3 || |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 262 | pte_index >= HPT_NPTE) { |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 263 | /* parameter error */ |
| 264 | args[i * 2] = ((0xa0 | flags) << 56) + pte_index; |
| 265 | ret = H_PARAMETER; |
| 266 | break; |
| 267 | } |
| 268 | hp = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 269 | while (!try_lock_hpte(hp, HPTE_V_HVLOCK)) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 270 | cpu_relax(); |
| 271 | found = 0; |
| 272 | if (hp[0] & HPTE_V_VALID) { |
| 273 | switch (flags & 3) { |
| 274 | case 0: /* absolute */ |
| 275 | found = 1; |
| 276 | break; |
| 277 | case 1: /* andcond */ |
| 278 | if (!(hp[0] & args[i * 2 + 1])) |
| 279 | found = 1; |
| 280 | break; |
| 281 | case 2: /* AVPN */ |
| 282 | if ((hp[0] & ~0x7fUL) == args[i * 2 + 1]) |
| 283 | found = 1; |
| 284 | break; |
| 285 | } |
| 286 | } |
| 287 | if (!found) { |
| 288 | hp[0] &= ~HPTE_V_HVLOCK; |
| 289 | args[i * 2] = ((0x90 | flags) << 56) + pte_index; |
| 290 | continue; |
| 291 | } |
| 292 | /* insert R and C bits from PTE */ |
| 293 | flags |= (hp[1] >> 5) & 0x0c; |
| 294 | args[i * 2] = ((0x80 | flags) << 56) + pte_index; |
| 295 | tlbrb[n_inval++] = compute_tlbie_rb(hp[0], hp[1], pte_index); |
| 296 | hp[0] = 0; |
| 297 | } |
| 298 | if (n_inval == 0) |
| 299 | return ret; |
| 300 | |
| 301 | if (!local) { |
| 302 | while(!try_lock_tlbie(&kvm->arch.tlbie_lock)) |
| 303 | cpu_relax(); |
| 304 | asm volatile("ptesync" : : : "memory"); |
| 305 | for (i = 0; i < n_inval; ++i) |
| 306 | asm volatile(PPC_TLBIE(%1,%0) |
| 307 | : : "r" (tlbrb[i]), "r" (kvm->arch.lpid)); |
| 308 | asm volatile("eieio; tlbsync; ptesync" : : : "memory"); |
| 309 | kvm->arch.tlbie_lock = 0; |
| 310 | } else { |
| 311 | asm volatile("ptesync" : : : "memory"); |
| 312 | for (i = 0; i < n_inval; ++i) |
| 313 | asm volatile("tlbiel %0" : : "r" (tlbrb[i])); |
| 314 | asm volatile("ptesync" : : : "memory"); |
| 315 | } |
| 316 | return ret; |
| 317 | } |
| 318 | |
| 319 | long kvmppc_h_protect(struct kvm_vcpu *vcpu, unsigned long flags, |
| 320 | unsigned long pte_index, unsigned long avpn, |
| 321 | unsigned long va) |
| 322 | { |
| 323 | struct kvm *kvm = vcpu->kvm; |
| 324 | unsigned long *hpte; |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 325 | struct revmap_entry *rev; |
| 326 | unsigned long v, r, rb, mask, bits; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 327 | |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 328 | if (pte_index >= HPT_NPTE) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 329 | return H_PARAMETER; |
| 330 | hpte = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
Paul Mackerras | 075295d | 2011-12-12 12:30:16 +0000 | [diff] [blame] | 331 | while (!try_lock_hpte(hpte, HPTE_V_HVLOCK)) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 332 | cpu_relax(); |
| 333 | if ((hpte[0] & HPTE_V_VALID) == 0 || |
| 334 | ((flags & H_AVPN) && (hpte[0] & ~0x7fUL) != avpn)) { |
| 335 | hpte[0] &= ~HPTE_V_HVLOCK; |
| 336 | return H_NOT_FOUND; |
| 337 | } |
| 338 | if (atomic_read(&kvm->online_vcpus) == 1) |
| 339 | flags |= H_LOCAL; |
| 340 | v = hpte[0]; |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 341 | bits = (flags << 55) & HPTE_R_PP0; |
| 342 | bits |= (flags << 48) & HPTE_R_KEY_HI; |
| 343 | bits |= flags & (HPTE_R_PP | HPTE_R_N | HPTE_R_KEY_LO); |
| 344 | |
| 345 | /* Update guest view of 2nd HPTE dword */ |
| 346 | mask = HPTE_R_PP0 | HPTE_R_PP | HPTE_R_N | |
| 347 | HPTE_R_KEY_HI | HPTE_R_KEY_LO; |
| 348 | rev = real_vmalloc_addr(&kvm->arch.revmap[pte_index]); |
| 349 | if (rev) { |
| 350 | r = (rev->guest_rpte & ~mask) | bits; |
| 351 | rev->guest_rpte = r; |
| 352 | } |
| 353 | r = (hpte[1] & ~mask) | bits; |
| 354 | |
| 355 | /* Update HPTE */ |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 356 | rb = compute_tlbie_rb(v, r, pte_index); |
| 357 | hpte[0] = v & ~HPTE_V_VALID; |
| 358 | if (!(flags & H_LOCAL)) { |
| 359 | while(!try_lock_tlbie(&kvm->arch.tlbie_lock)) |
| 360 | cpu_relax(); |
| 361 | asm volatile("ptesync" : : : "memory"); |
| 362 | asm volatile(PPC_TLBIE(%1,%0)"; eieio; tlbsync" |
| 363 | : : "r" (rb), "r" (kvm->arch.lpid)); |
| 364 | asm volatile("ptesync" : : : "memory"); |
| 365 | kvm->arch.tlbie_lock = 0; |
| 366 | } else { |
| 367 | asm volatile("ptesync" : : : "memory"); |
| 368 | asm volatile("tlbiel %0" : : "r" (rb)); |
| 369 | asm volatile("ptesync" : : : "memory"); |
| 370 | } |
| 371 | hpte[1] = r; |
| 372 | eieio(); |
| 373 | hpte[0] = v & ~HPTE_V_HVLOCK; |
| 374 | asm volatile("ptesync" : : : "memory"); |
| 375 | return H_SUCCESS; |
| 376 | } |
| 377 | |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 378 | long kvmppc_h_read(struct kvm_vcpu *vcpu, unsigned long flags, |
| 379 | unsigned long pte_index) |
| 380 | { |
| 381 | struct kvm *kvm = vcpu->kvm; |
| 382 | unsigned long *hpte, r; |
| 383 | int i, n = 1; |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 384 | struct revmap_entry *rev = NULL; |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 385 | |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 386 | if (pte_index >= HPT_NPTE) |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 387 | return H_PARAMETER; |
| 388 | if (flags & H_READ_4) { |
| 389 | pte_index &= ~3; |
| 390 | n = 4; |
| 391 | } |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 392 | if (flags & H_R_XLATE) |
| 393 | rev = real_vmalloc_addr(&kvm->arch.revmap[pte_index]); |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 394 | for (i = 0; i < n; ++i, ++pte_index) { |
| 395 | hpte = (unsigned long *)(kvm->arch.hpt_virt + (pte_index << 4)); |
| 396 | r = hpte[1]; |
Paul Mackerras | 8936dda | 2011-12-12 12:27:39 +0000 | [diff] [blame] | 397 | if (hpte[0] & HPTE_V_VALID) { |
| 398 | if (rev) |
| 399 | r = rev[i].guest_rpte; |
| 400 | else |
| 401 | r = hpte[1] | HPTE_R_RPN; |
| 402 | } |
Paul Mackerras | a8606e2 | 2011-06-29 00:22:05 +0000 | [diff] [blame] | 403 | vcpu->arch.gpr[4 + i * 2] = hpte[0]; |
| 404 | vcpu->arch.gpr[5 + i * 2] = r; |
| 405 | } |
| 406 | return H_SUCCESS; |
| 407 | } |