12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156 |
- /*
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License, version 2, as
- * published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
- *
- * Copyright 2010 Paul Mackerras, IBM Corp. <paulus@au1.ibm.com>
- */
- #include <linux/types.h>
- #include <linux/string.h>
- #include <linux/kvm.h>
- #include <linux/kvm_host.h>
- #include <linux/highmem.h>
- #include <linux/gfp.h>
- #include <linux/slab.h>
- #include <linux/hugetlb.h>
- #include <linux/vmalloc.h>
- #include <linux/srcu.h>
- #include <linux/anon_inodes.h>
- #include <linux/file.h>
- #include <linux/debugfs.h>
- #include <asm/kvm_ppc.h>
- #include <asm/kvm_book3s.h>
- #include <asm/book3s/64/mmu-hash.h>
- #include <asm/hvcall.h>
- #include <asm/synch.h>
- #include <asm/ppc-opcode.h>
- #include <asm/cputable.h>
- #include <asm/pte-walk.h>
- #include "trace_hv.h"
- //#define DEBUG_RESIZE_HPT 1
- #ifdef DEBUG_RESIZE_HPT
- #define resize_hpt_debug(resize, ...) \
- do { \
- printk(KERN_DEBUG "RESIZE HPT %p: ", resize); \
- printk(__VA_ARGS__); \
- } while (0)
- #else
- #define resize_hpt_debug(resize, ...) \
- do { } while (0)
- #endif
- static long kvmppc_virtmode_do_h_enter(struct kvm *kvm, unsigned long flags,
- long pte_index, unsigned long pteh,
- unsigned long ptel, unsigned long *pte_idx_ret);
- struct kvm_resize_hpt {
- /* These fields read-only after init */
- struct kvm *kvm;
- struct work_struct work;
- u32 order;
- /* These fields protected by kvm->lock */
- /* Possible values and their usage:
- * <0 an error occurred during allocation,
- * -EBUSY allocation is in the progress,
- * 0 allocation made successfuly.
- */
- int error;
- /* Private to the work thread, until error != -EBUSY,
- * then protected by kvm->lock.
- */
- struct kvm_hpt_info hpt;
- };
- int kvmppc_allocate_hpt(struct kvm_hpt_info *info, u32 order)
- {
- unsigned long hpt = 0;
- int cma = 0;
- struct page *page = NULL;
- struct revmap_entry *rev;
- unsigned long npte;
- if ((order < PPC_MIN_HPT_ORDER) || (order > PPC_MAX_HPT_ORDER))
- return -EINVAL;
- page = kvm_alloc_hpt_cma(1ul << (order - PAGE_SHIFT));
- if (page) {
- hpt = (unsigned long)pfn_to_kaddr(page_to_pfn(page));
- memset((void *)hpt, 0, (1ul << order));
- cma = 1;
- }
- if (!hpt)
- hpt = __get_free_pages(GFP_KERNEL|__GFP_ZERO|__GFP_RETRY_MAYFAIL
- |__GFP_NOWARN, order - PAGE_SHIFT);
- if (!hpt)
- return -ENOMEM;
- /* HPTEs are 2**4 bytes long */
- npte = 1ul << (order - 4);
- /* Allocate reverse map array */
- rev = vmalloc(array_size(npte, sizeof(struct revmap_entry)));
- if (!rev) {
- if (cma)
- kvm_free_hpt_cma(page, 1 << (order - PAGE_SHIFT));
- else
- free_pages(hpt, order - PAGE_SHIFT);
- return -ENOMEM;
- }
- info->order = order;
- info->virt = hpt;
- info->cma = cma;
- info->rev = rev;
- return 0;
- }
- void kvmppc_set_hpt(struct kvm *kvm, struct kvm_hpt_info *info)
- {
- atomic64_set(&kvm->arch.mmio_update, 0);
- kvm->arch.hpt = *info;
- kvm->arch.sdr1 = __pa(info->virt) | (info->order - 18);
- pr_debug("KVM guest htab at %lx (order %ld), LPID %x\n",
- info->virt, (long)info->order, kvm->arch.lpid);
- }
- long kvmppc_alloc_reset_hpt(struct kvm *kvm, int order)
- {
- long err = -EBUSY;
- struct kvm_hpt_info info;
- mutex_lock(&kvm->lock);
- if (kvm->arch.mmu_ready) {
- kvm->arch.mmu_ready = 0;
- /* order mmu_ready vs. vcpus_running */
- smp_mb();
- if (atomic_read(&kvm->arch.vcpus_running)) {
- kvm->arch.mmu_ready = 1;
- goto out;
- }
- }
- if (kvm_is_radix(kvm)) {
- err = kvmppc_switch_mmu_to_hpt(kvm);
- if (err)
- goto out;
- }
- if (kvm->arch.hpt.order == order) {
- /* We already have a suitable HPT */
- /* Set the entire HPT to 0, i.e. invalid HPTEs */
- memset((void *)kvm->arch.hpt.virt, 0, 1ul << order);
- /*
- * Reset all the reverse-mapping chains for all memslots
- */
- kvmppc_rmap_reset(kvm);
- err = 0;
- goto out;
- }
- if (kvm->arch.hpt.virt) {
- kvmppc_free_hpt(&kvm->arch.hpt);
- kvmppc_rmap_reset(kvm);
- }
- err = kvmppc_allocate_hpt(&info, order);
- if (err < 0)
- goto out;
- kvmppc_set_hpt(kvm, &info);
- out:
- if (err == 0)
- /* Ensure that each vcpu will flush its TLB on next entry. */
- cpumask_setall(&kvm->arch.need_tlb_flush);
- mutex_unlock(&kvm->lock);
- return err;
- }
- void kvmppc_free_hpt(struct kvm_hpt_info *info)
- {
- vfree(info->rev);
- info->rev = NULL;
- if (info->cma)
- kvm_free_hpt_cma(virt_to_page(info->virt),
- 1 << (info->order - PAGE_SHIFT));
- else if (info->virt)
- free_pages(info->virt, info->order - PAGE_SHIFT);
- info->virt = 0;
- info->order = 0;
- }
- /* Bits in first HPTE dword for pagesize 4k, 64k or 16M */
- static inline unsigned long hpte0_pgsize_encoding(unsigned long pgsize)
- {
- return (pgsize > 0x1000) ? HPTE_V_LARGE : 0;
- }
- /* Bits in second HPTE dword for pagesize 4k, 64k or 16M */
- static inline unsigned long hpte1_pgsize_encoding(unsigned long pgsize)
- {
- return (pgsize == 0x10000) ? 0x1000 : 0;
- }
- void kvmppc_map_vrma(struct kvm_vcpu *vcpu, struct kvm_memory_slot *memslot,
- unsigned long porder)
- {
- unsigned long i;
- unsigned long npages;
- unsigned long hp_v, hp_r;
- unsigned long addr, hash;
- unsigned long psize;
- unsigned long hp0, hp1;
- unsigned long idx_ret;
- long ret;
- struct kvm *kvm = vcpu->kvm;
- psize = 1ul << porder;
- npages = memslot->npages >> (porder - PAGE_SHIFT);
- /* VRMA can't be > 1TB */
- if (npages > 1ul << (40 - porder))
- npages = 1ul << (40 - porder);
- /* Can't use more than 1 HPTE per HPTEG */
- if (npages > kvmppc_hpt_mask(&kvm->arch.hpt) + 1)
- npages = kvmppc_hpt_mask(&kvm->arch.hpt) + 1;
- hp0 = HPTE_V_1TB_SEG | (VRMA_VSID << (40 - 16)) |
- HPTE_V_BOLTED | hpte0_pgsize_encoding(psize);
- hp1 = hpte1_pgsize_encoding(psize) |
- HPTE_R_R | HPTE_R_C | HPTE_R_M | PP_RWXX;
- for (i = 0; i < npages; ++i) {
- addr = i << porder;
- /* can't use hpt_hash since va > 64 bits */
- hash = (i ^ (VRMA_VSID ^ (VRMA_VSID << 25)))
- & kvmppc_hpt_mask(&kvm->arch.hpt);
- /*
- * We assume that the hash table is empty and no
- * vcpus are using it at this stage. Since we create
- * at most one HPTE per HPTEG, we just assume entry 7
- * is available and use it.
- */
- hash = (hash << 3) + 7;
- hp_v = hp0 | ((addr >> 16) & ~0x7fUL);
- hp_r = hp1 | addr;
- ret = kvmppc_virtmode_do_h_enter(kvm, H_EXACT, hash, hp_v, hp_r,
- &idx_ret);
- if (ret != H_SUCCESS) {
- pr_err("KVM: map_vrma at %lx failed, ret=%ld\n",
- addr, ret);
- break;
- }
- }
- }
- int kvmppc_mmu_hv_init(void)
- {
- unsigned long host_lpid, rsvd_lpid;
- if (!mmu_has_feature(MMU_FTR_LOCKLESS_TLBIE))
- return -EINVAL;
- /* POWER7 has 10-bit LPIDs (12-bit in POWER8) */
- host_lpid = 0;
- if (cpu_has_feature(CPU_FTR_HVMODE))
- host_lpid = mfspr(SPRN_LPID);
- rsvd_lpid = LPID_RSVD;
- kvmppc_init_lpid(rsvd_lpid + 1);
- kvmppc_claim_lpid(host_lpid);
- /* rsvd_lpid is reserved for use in partition switching */
- kvmppc_claim_lpid(rsvd_lpid);
- return 0;
- }
- static void kvmppc_mmu_book3s_64_hv_reset_msr(struct kvm_vcpu *vcpu)
- {
- unsigned long msr = vcpu->arch.intr_msr;
- /* If transactional, change to suspend mode on IRQ delivery */
- if (MSR_TM_TRANSACTIONAL(vcpu->arch.shregs.msr))
- msr |= MSR_TS_S;
- else
- msr |= vcpu->arch.shregs.msr & MSR_TS_MASK;
- kvmppc_set_msr(vcpu, msr);
- }
- static long kvmppc_virtmode_do_h_enter(struct kvm *kvm, unsigned long flags,
- long pte_index, unsigned long pteh,
- unsigned long ptel, unsigned long *pte_idx_ret)
- {
- long ret;
- /* Protect linux PTE lookup from page table destruction */
- rcu_read_lock_sched(); /* this disables preemption too */
- ret = kvmppc_do_h_enter(kvm, flags, pte_index, pteh, ptel,
- current->mm->pgd, false, pte_idx_ret);
- rcu_read_unlock_sched();
- if (ret == H_TOO_HARD) {
- /* this can't happen */
- pr_err("KVM: Oops, kvmppc_h_enter returned too hard!\n");
- ret = H_RESOURCE; /* or something */
- }
- return ret;
- }
- static struct kvmppc_slb *kvmppc_mmu_book3s_hv_find_slbe(struct kvm_vcpu *vcpu,
- gva_t eaddr)
- {
- u64 mask;
- int i;
- for (i = 0; i < vcpu->arch.slb_nr; i++) {
- if (!(vcpu->arch.slb[i].orige & SLB_ESID_V))
- continue;
- if (vcpu->arch.slb[i].origv & SLB_VSID_B_1T)
- mask = ESID_MASK_1T;
- else
- mask = ESID_MASK;
- if (((vcpu->arch.slb[i].orige ^ eaddr) & mask) == 0)
- return &vcpu->arch.slb[i];
- }
- return NULL;
- }
- static unsigned long kvmppc_mmu_get_real_addr(unsigned long v, unsigned long r,
- unsigned long ea)
- {
- unsigned long ra_mask;
- ra_mask = kvmppc_actual_pgsz(v, r) - 1;
- return (r & HPTE_R_RPN & ~ra_mask) | (ea & ra_mask);
- }
- static int kvmppc_mmu_book3s_64_hv_xlate(struct kvm_vcpu *vcpu, gva_t eaddr,
- struct kvmppc_pte *gpte, bool data, bool iswrite)
- {
- struct kvm *kvm = vcpu->kvm;
- struct kvmppc_slb *slbe;
- unsigned long slb_v;
- unsigned long pp, key;
- unsigned long v, orig_v, gr;
- __be64 *hptep;
- long int index;
- int virtmode = vcpu->arch.shregs.msr & (data ? MSR_DR : MSR_IR);
- if (kvm_is_radix(vcpu->kvm))
- return kvmppc_mmu_radix_xlate(vcpu, eaddr, gpte, data, iswrite);
- /* Get SLB entry */
- if (virtmode) {
- slbe = kvmppc_mmu_book3s_hv_find_slbe(vcpu, eaddr);
- if (!slbe)
- return -EINVAL;
- slb_v = slbe->origv;
- } else {
- /* real mode access */
- slb_v = vcpu->kvm->arch.vrma_slb_v;
- }
- preempt_disable();
- /* Find the HPTE in the hash table */
- index = kvmppc_hv_find_lock_hpte(kvm, eaddr, slb_v,
- HPTE_V_VALID | HPTE_V_ABSENT);
- if (index < 0) {
- preempt_enable();
- return -ENOENT;
- }
- hptep = (__be64 *)(kvm->arch.hpt.virt + (index << 4));
- v = orig_v = be64_to_cpu(hptep[0]) & ~HPTE_V_HVLOCK;
- if (cpu_has_feature(CPU_FTR_ARCH_300))
- v = hpte_new_to_old_v(v, be64_to_cpu(hptep[1]));
- gr = kvm->arch.hpt.rev[index].guest_rpte;
- unlock_hpte(hptep, orig_v);
- preempt_enable();
- gpte->eaddr = eaddr;
- gpte->vpage = ((v & HPTE_V_AVPN) << 4) | ((eaddr >> 12) & 0xfff);
- /* Get PP bits and key for permission check */
- pp = gr & (HPTE_R_PP0 | HPTE_R_PP);
- key = (vcpu->arch.shregs.msr & MSR_PR) ? SLB_VSID_KP : SLB_VSID_KS;
- key &= slb_v;
- /* Calculate permissions */
- gpte->may_read = hpte_read_permission(pp, key);
- gpte->may_write = hpte_write_permission(pp, key);
- gpte->may_execute = gpte->may_read && !(gr & (HPTE_R_N | HPTE_R_G));
- /* Storage key permission check for POWER7 */
- if (data && virtmode) {
- int amrfield = hpte_get_skey_perm(gr, vcpu->arch.amr);
- if (amrfield & 1)
- gpte->may_read = 0;
- if (amrfield & 2)
- gpte->may_write = 0;
- }
- /* Get the guest physical address */
- gpte->raddr = kvmppc_mmu_get_real_addr(v, gr, eaddr);
- return 0;
- }
- /*
- * Quick test for whether an instruction is a load or a store.
- * If the instruction is a load or a store, then this will indicate
- * which it is, at least on server processors. (Embedded processors
- * have some external PID instructions that don't follow the rule
- * embodied here.) If the instruction isn't a load or store, then
- * this doesn't return anything useful.
- */
- static int instruction_is_store(unsigned int instr)
- {
- unsigned int mask;
- mask = 0x10000000;
- if ((instr & 0xfc000000) == 0x7c000000)
- mask = 0x100; /* major opcode 31 */
- return (instr & mask) != 0;
- }
- int kvmppc_hv_emulate_mmio(struct kvm_run *run, struct kvm_vcpu *vcpu,
- unsigned long gpa, gva_t ea, int is_store)
- {
- u32 last_inst;
- /*
- * If we fail, we just return to the guest and try executing it again.
- */
- if (kvmppc_get_last_inst(vcpu, INST_GENERIC, &last_inst) !=
- EMULATE_DONE)
- return RESUME_GUEST;
- /*
- * WARNING: We do not know for sure whether the instruction we just
- * read from memory is the same that caused the fault in the first
- * place. If the instruction we read is neither an load or a store,
- * then it can't access memory, so we don't need to worry about
- * enforcing access permissions. So, assuming it is a load or
- * store, we just check that its direction (load or store) is
- * consistent with the original fault, since that's what we
- * checked the access permissions against. If there is a mismatch
- * we just return and retry the instruction.
- */
- if (instruction_is_store(last_inst) != !!is_store)
- return RESUME_GUEST;
- /*
- * Emulated accesses are emulated by looking at the hash for
- * translation once, then performing the access later. The
- * translation could be invalidated in the meantime in which
- * point performing the subsequent memory access on the old
- * physical address could possibly be a security hole for the
- * guest (but not the host).
- *
- * This is less of an issue for MMIO stores since they aren't
- * globally visible. It could be an issue for MMIO loads to
- * a certain extent but we'll ignore it for now.
- */
- vcpu->arch.paddr_accessed = gpa;
- vcpu->arch.vaddr_accessed = ea;
- return kvmppc_emulate_mmio(run, vcpu);
- }
- int kvmppc_book3s_hv_page_fault(struct kvm_run *run, struct kvm_vcpu *vcpu,
- unsigned long ea, unsigned long dsisr)
- {
- struct kvm *kvm = vcpu->kvm;
- unsigned long hpte[3], r;
- unsigned long hnow_v, hnow_r;
- __be64 *hptep;
- unsigned long mmu_seq, psize, pte_size;
- unsigned long gpa_base, gfn_base;
- unsigned long gpa, gfn, hva, pfn;
- struct kvm_memory_slot *memslot;
- unsigned long *rmap;
- struct revmap_entry *rev;
- struct page *page, *pages[1];
- long index, ret, npages;
- bool is_ci;
- unsigned int writing, write_ok;
- struct vm_area_struct *vma;
- unsigned long rcbits;
- long mmio_update;
- if (kvm_is_radix(kvm))
- return kvmppc_book3s_radix_page_fault(run, vcpu, ea, dsisr);
- /*
- * Real-mode code has already searched the HPT and found the
- * entry we're interested in. Lock the entry and check that
- * it hasn't changed. If it has, just return and re-execute the
- * instruction.
- */
- if (ea != vcpu->arch.pgfault_addr)
- return RESUME_GUEST;
- if (vcpu->arch.pgfault_cache) {
- mmio_update = atomic64_read(&kvm->arch.mmio_update);
- if (mmio_update == vcpu->arch.pgfault_cache->mmio_update) {
- r = vcpu->arch.pgfault_cache->rpte;
- psize = kvmppc_actual_pgsz(vcpu->arch.pgfault_hpte[0],
- r);
- gpa_base = r & HPTE_R_RPN & ~(psize - 1);
- gfn_base = gpa_base >> PAGE_SHIFT;
- gpa = gpa_base | (ea & (psize - 1));
- return kvmppc_hv_emulate_mmio(run, vcpu, gpa, ea,
- dsisr & DSISR_ISSTORE);
- }
- }
- index = vcpu->arch.pgfault_index;
- hptep = (__be64 *)(kvm->arch.hpt.virt + (index << 4));
- rev = &kvm->arch.hpt.rev[index];
- preempt_disable();
- while (!try_lock_hpte(hptep, HPTE_V_HVLOCK))
- cpu_relax();
- hpte[0] = be64_to_cpu(hptep[0]) & ~HPTE_V_HVLOCK;
- hpte[1] = be64_to_cpu(hptep[1]);
- hpte[2] = r = rev->guest_rpte;
- unlock_hpte(hptep, hpte[0]);
- preempt_enable();
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- hpte[0] = hpte_new_to_old_v(hpte[0], hpte[1]);
- hpte[1] = hpte_new_to_old_r(hpte[1]);
- }
- if (hpte[0] != vcpu->arch.pgfault_hpte[0] ||
- hpte[1] != vcpu->arch.pgfault_hpte[1])
- return RESUME_GUEST;
- /* Translate the logical address and get the page */
- psize = kvmppc_actual_pgsz(hpte[0], r);
- gpa_base = r & HPTE_R_RPN & ~(psize - 1);
- gfn_base = gpa_base >> PAGE_SHIFT;
- gpa = gpa_base | (ea & (psize - 1));
- gfn = gpa >> PAGE_SHIFT;
- memslot = gfn_to_memslot(kvm, gfn);
- trace_kvm_page_fault_enter(vcpu, hpte, memslot, ea, dsisr);
- /* No memslot means it's an emulated MMIO region */
- if (!memslot || (memslot->flags & KVM_MEMSLOT_INVALID))
- return kvmppc_hv_emulate_mmio(run, vcpu, gpa, ea,
- dsisr & DSISR_ISSTORE);
- /*
- * This should never happen, because of the slot_is_aligned()
- * check in kvmppc_do_h_enter().
- */
- if (gfn_base < memslot->base_gfn)
- return -EFAULT;
- /* used to check for invalidations in progress */
- mmu_seq = kvm->mmu_notifier_seq;
- smp_rmb();
- ret = -EFAULT;
- is_ci = false;
- pfn = 0;
- page = NULL;
- pte_size = PAGE_SIZE;
- writing = (dsisr & DSISR_ISSTORE) != 0;
- /* If writing != 0, then the HPTE must allow writing, if we get here */
- write_ok = writing;
- hva = gfn_to_hva_memslot(memslot, gfn);
- npages = get_user_pages_fast(hva, 1, writing, pages);
- if (npages < 1) {
- /* Check if it's an I/O mapping */
- down_read(¤t->mm->mmap_sem);
- vma = find_vma(current->mm, hva);
- if (vma && vma->vm_start <= hva && hva + psize <= vma->vm_end &&
- (vma->vm_flags & VM_PFNMAP)) {
- pfn = vma->vm_pgoff +
- ((hva - vma->vm_start) >> PAGE_SHIFT);
- pte_size = psize;
- is_ci = pte_ci(__pte((pgprot_val(vma->vm_page_prot))));
- write_ok = vma->vm_flags & VM_WRITE;
- }
- up_read(¤t->mm->mmap_sem);
- if (!pfn)
- goto out_put;
- } else {
- page = pages[0];
- pfn = page_to_pfn(page);
- if (PageHuge(page)) {
- page = compound_head(page);
- pte_size <<= compound_order(page);
- }
- /* if the guest wants write access, see if that is OK */
- if (!writing && hpte_is_writable(r)) {
- pte_t *ptep, pte;
- unsigned long flags;
- /*
- * We need to protect against page table destruction
- * hugepage split and collapse.
- */
- local_irq_save(flags);
- ptep = find_current_mm_pte(current->mm->pgd,
- hva, NULL, NULL);
- if (ptep) {
- pte = kvmppc_read_update_linux_pte(ptep, 1);
- if (__pte_write(pte))
- write_ok = 1;
- }
- local_irq_restore(flags);
- }
- }
- if (psize > pte_size)
- goto out_put;
- /* Check WIMG vs. the actual page we're accessing */
- if (!hpte_cache_flags_ok(r, is_ci)) {
- if (is_ci)
- goto out_put;
- /*
- * Allow guest to map emulated device memory as
- * uncacheable, but actually make it cacheable.
- */
- r = (r & ~(HPTE_R_W|HPTE_R_I|HPTE_R_G)) | HPTE_R_M;
- }
- /*
- * Set the HPTE to point to pfn.
- * Since the pfn is at PAGE_SIZE granularity, make sure we
- * don't mask out lower-order bits if psize < PAGE_SIZE.
- */
- if (psize < PAGE_SIZE)
- psize = PAGE_SIZE;
- r = (r & HPTE_R_KEY_HI) | (r & ~(HPTE_R_PP0 - psize)) |
- ((pfn << PAGE_SHIFT) & ~(psize - 1));
- if (hpte_is_writable(r) && !write_ok)
- r = hpte_make_readonly(r);
- ret = RESUME_GUEST;
- preempt_disable();
- while (!try_lock_hpte(hptep, HPTE_V_HVLOCK))
- cpu_relax();
- hnow_v = be64_to_cpu(hptep[0]);
- hnow_r = be64_to_cpu(hptep[1]);
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- hnow_v = hpte_new_to_old_v(hnow_v, hnow_r);
- hnow_r = hpte_new_to_old_r(hnow_r);
- }
- /*
- * If the HPT is being resized, don't update the HPTE,
- * instead let the guest retry after the resize operation is complete.
- * The synchronization for mmu_ready test vs. set is provided
- * by the HPTE lock.
- */
- if (!kvm->arch.mmu_ready)
- goto out_unlock;
- if ((hnow_v & ~HPTE_V_HVLOCK) != hpte[0] || hnow_r != hpte[1] ||
- rev->guest_rpte != hpte[2])
- /* HPTE has been changed under us; let the guest retry */
- goto out_unlock;
- hpte[0] = (hpte[0] & ~HPTE_V_ABSENT) | HPTE_V_VALID;
- /* Always put the HPTE in the rmap chain for the page base address */
- rmap = &memslot->arch.rmap[gfn_base - memslot->base_gfn];
- lock_rmap(rmap);
- /* Check if we might have been invalidated; let the guest retry if so */
- ret = RESUME_GUEST;
- if (mmu_notifier_retry(vcpu->kvm, mmu_seq)) {
- unlock_rmap(rmap);
- goto out_unlock;
- }
- /* Only set R/C in real HPTE if set in both *rmap and guest_rpte */
- rcbits = *rmap >> KVMPPC_RMAP_RC_SHIFT;
- r &= rcbits | ~(HPTE_R_R | HPTE_R_C);
- if (be64_to_cpu(hptep[0]) & HPTE_V_VALID) {
- /* HPTE was previously valid, so we need to invalidate it */
- unlock_rmap(rmap);
- hptep[0] |= cpu_to_be64(HPTE_V_ABSENT);
- kvmppc_invalidate_hpte(kvm, hptep, index);
- /* don't lose previous R and C bits */
- r |= be64_to_cpu(hptep[1]) & (HPTE_R_R | HPTE_R_C);
- } else {
- kvmppc_add_revmap_chain(kvm, rev, rmap, index, 0);
- }
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- r = hpte_old_to_new_r(hpte[0], r);
- hpte[0] = hpte_old_to_new_v(hpte[0]);
- }
- hptep[1] = cpu_to_be64(r);
- eieio();
- __unlock_hpte(hptep, hpte[0]);
- asm volatile("ptesync" : : : "memory");
- preempt_enable();
- if (page && hpte_is_writable(r))
- SetPageDirty(page);
- out_put:
- trace_kvm_page_fault_exit(vcpu, hpte, ret);
- if (page) {
- /*
- * We drop pages[0] here, not page because page might
- * have been set to the head page of a compound, but
- * we have to drop the reference on the correct tail
- * page to match the get inside gup()
- */
- put_page(pages[0]);
- }
- return ret;
- out_unlock:
- __unlock_hpte(hptep, be64_to_cpu(hptep[0]));
- preempt_enable();
- goto out_put;
- }
- void kvmppc_rmap_reset(struct kvm *kvm)
- {
- struct kvm_memslots *slots;
- struct kvm_memory_slot *memslot;
- int srcu_idx;
- srcu_idx = srcu_read_lock(&kvm->srcu);
- slots = kvm_memslots(kvm);
- kvm_for_each_memslot(memslot, slots) {
- /*
- * This assumes it is acceptable to lose reference and
- * change bits across a reset.
- */
- memset(memslot->arch.rmap, 0,
- memslot->npages * sizeof(*memslot->arch.rmap));
- }
- srcu_read_unlock(&kvm->srcu, srcu_idx);
- }
- typedef int (*hva_handler_fn)(struct kvm *kvm, struct kvm_memory_slot *memslot,
- unsigned long gfn);
- static int kvm_handle_hva_range(struct kvm *kvm,
- unsigned long start,
- unsigned long end,
- hva_handler_fn handler)
- {
- int ret;
- int retval = 0;
- struct kvm_memslots *slots;
- struct kvm_memory_slot *memslot;
- slots = kvm_memslots(kvm);
- kvm_for_each_memslot(memslot, slots) {
- unsigned long hva_start, hva_end;
- gfn_t gfn, gfn_end;
- hva_start = max(start, memslot->userspace_addr);
- hva_end = min(end, memslot->userspace_addr +
- (memslot->npages << PAGE_SHIFT));
- if (hva_start >= hva_end)
- continue;
- /*
- * {gfn(page) | page intersects with [hva_start, hva_end)} =
- * {gfn, gfn+1, ..., gfn_end-1}.
- */
- gfn = hva_to_gfn_memslot(hva_start, memslot);
- gfn_end = hva_to_gfn_memslot(hva_end + PAGE_SIZE - 1, memslot);
- for (; gfn < gfn_end; ++gfn) {
- ret = handler(kvm, memslot, gfn);
- retval |= ret;
- }
- }
- return retval;
- }
- static int kvm_handle_hva(struct kvm *kvm, unsigned long hva,
- hva_handler_fn handler)
- {
- return kvm_handle_hva_range(kvm, hva, hva + 1, handler);
- }
- /* Must be called with both HPTE and rmap locked */
- static void kvmppc_unmap_hpte(struct kvm *kvm, unsigned long i,
- struct kvm_memory_slot *memslot,
- unsigned long *rmapp, unsigned long gfn)
- {
- __be64 *hptep = (__be64 *) (kvm->arch.hpt.virt + (i << 4));
- struct revmap_entry *rev = kvm->arch.hpt.rev;
- unsigned long j, h;
- unsigned long ptel, psize, rcbits;
- j = rev[i].forw;
- if (j == i) {
- /* chain is now empty */
- *rmapp &= ~(KVMPPC_RMAP_PRESENT | KVMPPC_RMAP_INDEX);
- } else {
- /* remove i from chain */
- h = rev[i].back;
- rev[h].forw = j;
- rev[j].back = h;
- rev[i].forw = rev[i].back = i;
- *rmapp = (*rmapp & ~KVMPPC_RMAP_INDEX) | j;
- }
- /* Now check and modify the HPTE */
- ptel = rev[i].guest_rpte;
- psize = kvmppc_actual_pgsz(be64_to_cpu(hptep[0]), ptel);
- if ((be64_to_cpu(hptep[0]) & HPTE_V_VALID) &&
- hpte_rpn(ptel, psize) == gfn) {
- hptep[0] |= cpu_to_be64(HPTE_V_ABSENT);
- kvmppc_invalidate_hpte(kvm, hptep, i);
- hptep[1] &= ~cpu_to_be64(HPTE_R_KEY_HI | HPTE_R_KEY_LO);
- /* Harvest R and C */
- rcbits = be64_to_cpu(hptep[1]) & (HPTE_R_R | HPTE_R_C);
- *rmapp |= rcbits << KVMPPC_RMAP_RC_SHIFT;
- if ((rcbits & HPTE_R_C) && memslot->dirty_bitmap)
- kvmppc_update_dirty_map(memslot, gfn, psize);
- if (rcbits & ~rev[i].guest_rpte) {
- rev[i].guest_rpte = ptel | rcbits;
- note_hpte_modification(kvm, &rev[i]);
- }
- }
- }
- static int kvm_unmap_rmapp(struct kvm *kvm, struct kvm_memory_slot *memslot,
- unsigned long gfn)
- {
- unsigned long i;
- __be64 *hptep;
- unsigned long *rmapp;
- rmapp = &memslot->arch.rmap[gfn - memslot->base_gfn];
- for (;;) {
- lock_rmap(rmapp);
- if (!(*rmapp & KVMPPC_RMAP_PRESENT)) {
- unlock_rmap(rmapp);
- break;
- }
- /*
- * To avoid an ABBA deadlock with the HPTE lock bit,
- * we can't spin on the HPTE lock while holding the
- * rmap chain lock.
- */
- i = *rmapp & KVMPPC_RMAP_INDEX;
- hptep = (__be64 *) (kvm->arch.hpt.virt + (i << 4));
- if (!try_lock_hpte(hptep, HPTE_V_HVLOCK)) {
- /* unlock rmap before spinning on the HPTE lock */
- unlock_rmap(rmapp);
- while (be64_to_cpu(hptep[0]) & HPTE_V_HVLOCK)
- cpu_relax();
- continue;
- }
- kvmppc_unmap_hpte(kvm, i, memslot, rmapp, gfn);
- unlock_rmap(rmapp);
- __unlock_hpte(hptep, be64_to_cpu(hptep[0]));
- }
- return 0;
- }
- int kvm_unmap_hva_range_hv(struct kvm *kvm, unsigned long start, unsigned long end)
- {
- hva_handler_fn handler;
- handler = kvm_is_radix(kvm) ? kvm_unmap_radix : kvm_unmap_rmapp;
- kvm_handle_hva_range(kvm, start, end, handler);
- return 0;
- }
- void kvmppc_core_flush_memslot_hv(struct kvm *kvm,
- struct kvm_memory_slot *memslot)
- {
- unsigned long gfn;
- unsigned long n;
- unsigned long *rmapp;
- gfn = memslot->base_gfn;
- rmapp = memslot->arch.rmap;
- for (n = memslot->npages; n; --n, ++gfn) {
- if (kvm_is_radix(kvm)) {
- kvm_unmap_radix(kvm, memslot, gfn);
- continue;
- }
- /*
- * Testing the present bit without locking is OK because
- * the memslot has been marked invalid already, and hence
- * no new HPTEs referencing this page can be created,
- * thus the present bit can't go from 0 to 1.
- */
- if (*rmapp & KVMPPC_RMAP_PRESENT)
- kvm_unmap_rmapp(kvm, memslot, gfn);
- ++rmapp;
- }
- }
- static int kvm_age_rmapp(struct kvm *kvm, struct kvm_memory_slot *memslot,
- unsigned long gfn)
- {
- struct revmap_entry *rev = kvm->arch.hpt.rev;
- unsigned long head, i, j;
- __be64 *hptep;
- int ret = 0;
- unsigned long *rmapp;
- rmapp = &memslot->arch.rmap[gfn - memslot->base_gfn];
- retry:
- lock_rmap(rmapp);
- if (*rmapp & KVMPPC_RMAP_REFERENCED) {
- *rmapp &= ~KVMPPC_RMAP_REFERENCED;
- ret = 1;
- }
- if (!(*rmapp & KVMPPC_RMAP_PRESENT)) {
- unlock_rmap(rmapp);
- return ret;
- }
- i = head = *rmapp & KVMPPC_RMAP_INDEX;
- do {
- hptep = (__be64 *) (kvm->arch.hpt.virt + (i << 4));
- j = rev[i].forw;
- /* If this HPTE isn't referenced, ignore it */
- if (!(be64_to_cpu(hptep[1]) & HPTE_R_R))
- continue;
- if (!try_lock_hpte(hptep, HPTE_V_HVLOCK)) {
- /* unlock rmap before spinning on the HPTE lock */
- unlock_rmap(rmapp);
- while (be64_to_cpu(hptep[0]) & HPTE_V_HVLOCK)
- cpu_relax();
- goto retry;
- }
- /* Now check and modify the HPTE */
- if ((be64_to_cpu(hptep[0]) & HPTE_V_VALID) &&
- (be64_to_cpu(hptep[1]) & HPTE_R_R)) {
- kvmppc_clear_ref_hpte(kvm, hptep, i);
- if (!(rev[i].guest_rpte & HPTE_R_R)) {
- rev[i].guest_rpte |= HPTE_R_R;
- note_hpte_modification(kvm, &rev[i]);
- }
- ret = 1;
- }
- __unlock_hpte(hptep, be64_to_cpu(hptep[0]));
- } while ((i = j) != head);
- unlock_rmap(rmapp);
- return ret;
- }
- int kvm_age_hva_hv(struct kvm *kvm, unsigned long start, unsigned long end)
- {
- hva_handler_fn handler;
- handler = kvm_is_radix(kvm) ? kvm_age_radix : kvm_age_rmapp;
- return kvm_handle_hva_range(kvm, start, end, handler);
- }
- static int kvm_test_age_rmapp(struct kvm *kvm, struct kvm_memory_slot *memslot,
- unsigned long gfn)
- {
- struct revmap_entry *rev = kvm->arch.hpt.rev;
- unsigned long head, i, j;
- unsigned long *hp;
- int ret = 1;
- unsigned long *rmapp;
- rmapp = &memslot->arch.rmap[gfn - memslot->base_gfn];
- if (*rmapp & KVMPPC_RMAP_REFERENCED)
- return 1;
- lock_rmap(rmapp);
- if (*rmapp & KVMPPC_RMAP_REFERENCED)
- goto out;
- if (*rmapp & KVMPPC_RMAP_PRESENT) {
- i = head = *rmapp & KVMPPC_RMAP_INDEX;
- do {
- hp = (unsigned long *)(kvm->arch.hpt.virt + (i << 4));
- j = rev[i].forw;
- if (be64_to_cpu(hp[1]) & HPTE_R_R)
- goto out;
- } while ((i = j) != head);
- }
- ret = 0;
- out:
- unlock_rmap(rmapp);
- return ret;
- }
- int kvm_test_age_hva_hv(struct kvm *kvm, unsigned long hva)
- {
- hva_handler_fn handler;
- handler = kvm_is_radix(kvm) ? kvm_test_age_radix : kvm_test_age_rmapp;
- return kvm_handle_hva(kvm, hva, handler);
- }
- void kvm_set_spte_hva_hv(struct kvm *kvm, unsigned long hva, pte_t pte)
- {
- hva_handler_fn handler;
- handler = kvm_is_radix(kvm) ? kvm_unmap_radix : kvm_unmap_rmapp;
- kvm_handle_hva(kvm, hva, handler);
- }
- static int vcpus_running(struct kvm *kvm)
- {
- return atomic_read(&kvm->arch.vcpus_running) != 0;
- }
- /*
- * Returns the number of system pages that are dirty.
- * This can be more than 1 if we find a huge-page HPTE.
- */
- static int kvm_test_clear_dirty_npages(struct kvm *kvm, unsigned long *rmapp)
- {
- struct revmap_entry *rev = kvm->arch.hpt.rev;
- unsigned long head, i, j;
- unsigned long n;
- unsigned long v, r;
- __be64 *hptep;
- int npages_dirty = 0;
- retry:
- lock_rmap(rmapp);
- if (!(*rmapp & KVMPPC_RMAP_PRESENT)) {
- unlock_rmap(rmapp);
- return npages_dirty;
- }
- i = head = *rmapp & KVMPPC_RMAP_INDEX;
- do {
- unsigned long hptep1;
- hptep = (__be64 *) (kvm->arch.hpt.virt + (i << 4));
- j = rev[i].forw;
- /*
- * Checking the C (changed) bit here is racy since there
- * is no guarantee about when the hardware writes it back.
- * If the HPTE is not writable then it is stable since the
- * page can't be written to, and we would have done a tlbie
- * (which forces the hardware to complete any writeback)
- * when making the HPTE read-only.
- * If vcpus are running then this call is racy anyway
- * since the page could get dirtied subsequently, so we
- * expect there to be a further call which would pick up
- * any delayed C bit writeback.
- * Otherwise we need to do the tlbie even if C==0 in
- * order to pick up any delayed writeback of C.
- */
- hptep1 = be64_to_cpu(hptep[1]);
- if (!(hptep1 & HPTE_R_C) &&
- (!hpte_is_writable(hptep1) || vcpus_running(kvm)))
- continue;
- if (!try_lock_hpte(hptep, HPTE_V_HVLOCK)) {
- /* unlock rmap before spinning on the HPTE lock */
- unlock_rmap(rmapp);
- while (hptep[0] & cpu_to_be64(HPTE_V_HVLOCK))
- cpu_relax();
- goto retry;
- }
- /* Now check and modify the HPTE */
- if (!(hptep[0] & cpu_to_be64(HPTE_V_VALID))) {
- __unlock_hpte(hptep, be64_to_cpu(hptep[0]));
- continue;
- }
- /* need to make it temporarily absent so C is stable */
- hptep[0] |= cpu_to_be64(HPTE_V_ABSENT);
- kvmppc_invalidate_hpte(kvm, hptep, i);
- v = be64_to_cpu(hptep[0]);
- r = be64_to_cpu(hptep[1]);
- if (r & HPTE_R_C) {
- hptep[1] = cpu_to_be64(r & ~HPTE_R_C);
- if (!(rev[i].guest_rpte & HPTE_R_C)) {
- rev[i].guest_rpte |= HPTE_R_C;
- note_hpte_modification(kvm, &rev[i]);
- }
- n = kvmppc_actual_pgsz(v, r);
- n = (n + PAGE_SIZE - 1) >> PAGE_SHIFT;
- if (n > npages_dirty)
- npages_dirty = n;
- eieio();
- }
- v &= ~HPTE_V_ABSENT;
- v |= HPTE_V_VALID;
- __unlock_hpte(hptep, v);
- } while ((i = j) != head);
- unlock_rmap(rmapp);
- return npages_dirty;
- }
- void kvmppc_harvest_vpa_dirty(struct kvmppc_vpa *vpa,
- struct kvm_memory_slot *memslot,
- unsigned long *map)
- {
- unsigned long gfn;
- if (!vpa->dirty || !vpa->pinned_addr)
- return;
- gfn = vpa->gpa >> PAGE_SHIFT;
- if (gfn < memslot->base_gfn ||
- gfn >= memslot->base_gfn + memslot->npages)
- return;
- vpa->dirty = false;
- if (map)
- __set_bit_le(gfn - memslot->base_gfn, map);
- }
- long kvmppc_hv_get_dirty_log_hpt(struct kvm *kvm,
- struct kvm_memory_slot *memslot, unsigned long *map)
- {
- unsigned long i;
- unsigned long *rmapp;
- preempt_disable();
- rmapp = memslot->arch.rmap;
- for (i = 0; i < memslot->npages; ++i) {
- int npages = kvm_test_clear_dirty_npages(kvm, rmapp);
- /*
- * Note that if npages > 0 then i must be a multiple of npages,
- * since we always put huge-page HPTEs in the rmap chain
- * corresponding to their page base address.
- */
- if (npages)
- set_dirty_bits(map, i, npages);
- ++rmapp;
- }
- preempt_enable();
- return 0;
- }
- void *kvmppc_pin_guest_page(struct kvm *kvm, unsigned long gpa,
- unsigned long *nb_ret)
- {
- struct kvm_memory_slot *memslot;
- unsigned long gfn = gpa >> PAGE_SHIFT;
- struct page *page, *pages[1];
- int npages;
- unsigned long hva, offset;
- int srcu_idx;
- srcu_idx = srcu_read_lock(&kvm->srcu);
- memslot = gfn_to_memslot(kvm, gfn);
- if (!memslot || (memslot->flags & KVM_MEMSLOT_INVALID))
- goto err;
- hva = gfn_to_hva_memslot(memslot, gfn);
- npages = get_user_pages_fast(hva, 1, 1, pages);
- if (npages < 1)
- goto err;
- page = pages[0];
- srcu_read_unlock(&kvm->srcu, srcu_idx);
- offset = gpa & (PAGE_SIZE - 1);
- if (nb_ret)
- *nb_ret = PAGE_SIZE - offset;
- return page_address(page) + offset;
- err:
- srcu_read_unlock(&kvm->srcu, srcu_idx);
- return NULL;
- }
- void kvmppc_unpin_guest_page(struct kvm *kvm, void *va, unsigned long gpa,
- bool dirty)
- {
- struct page *page = virt_to_page(va);
- struct kvm_memory_slot *memslot;
- unsigned long gfn;
- int srcu_idx;
- put_page(page);
- if (!dirty)
- return;
- /* We need to mark this page dirty in the memslot dirty_bitmap, if any */
- gfn = gpa >> PAGE_SHIFT;
- srcu_idx = srcu_read_lock(&kvm->srcu);
- memslot = gfn_to_memslot(kvm, gfn);
- if (memslot && memslot->dirty_bitmap)
- set_bit_le(gfn - memslot->base_gfn, memslot->dirty_bitmap);
- srcu_read_unlock(&kvm->srcu, srcu_idx);
- }
- /*
- * HPT resizing
- */
- static int resize_hpt_allocate(struct kvm_resize_hpt *resize)
- {
- int rc;
- rc = kvmppc_allocate_hpt(&resize->hpt, resize->order);
- if (rc < 0)
- return rc;
- resize_hpt_debug(resize, "resize_hpt_allocate(): HPT @ 0x%lx\n",
- resize->hpt.virt);
- return 0;
- }
- static unsigned long resize_hpt_rehash_hpte(struct kvm_resize_hpt *resize,
- unsigned long idx)
- {
- struct kvm *kvm = resize->kvm;
- struct kvm_hpt_info *old = &kvm->arch.hpt;
- struct kvm_hpt_info *new = &resize->hpt;
- unsigned long old_hash_mask = (1ULL << (old->order - 7)) - 1;
- unsigned long new_hash_mask = (1ULL << (new->order - 7)) - 1;
- __be64 *hptep, *new_hptep;
- unsigned long vpte, rpte, guest_rpte;
- int ret;
- struct revmap_entry *rev;
- unsigned long apsize, avpn, pteg, hash;
- unsigned long new_idx, new_pteg, replace_vpte;
- int pshift;
- hptep = (__be64 *)(old->virt + (idx << 4));
- /* Guest is stopped, so new HPTEs can't be added or faulted
- * in, only unmapped or altered by host actions. So, it's
- * safe to check this before we take the HPTE lock */
- vpte = be64_to_cpu(hptep[0]);
- if (!(vpte & HPTE_V_VALID) && !(vpte & HPTE_V_ABSENT))
- return 0; /* nothing to do */
- while (!try_lock_hpte(hptep, HPTE_V_HVLOCK))
- cpu_relax();
- vpte = be64_to_cpu(hptep[0]);
- ret = 0;
- if (!(vpte & HPTE_V_VALID) && !(vpte & HPTE_V_ABSENT))
- /* Nothing to do */
- goto out;
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- rpte = be64_to_cpu(hptep[1]);
- vpte = hpte_new_to_old_v(vpte, rpte);
- }
- /* Unmap */
- rev = &old->rev[idx];
- guest_rpte = rev->guest_rpte;
- ret = -EIO;
- apsize = kvmppc_actual_pgsz(vpte, guest_rpte);
- if (!apsize)
- goto out;
- if (vpte & HPTE_V_VALID) {
- unsigned long gfn = hpte_rpn(guest_rpte, apsize);
- int srcu_idx = srcu_read_lock(&kvm->srcu);
- struct kvm_memory_slot *memslot =
- __gfn_to_memslot(kvm_memslots(kvm), gfn);
- if (memslot) {
- unsigned long *rmapp;
- rmapp = &memslot->arch.rmap[gfn - memslot->base_gfn];
- lock_rmap(rmapp);
- kvmppc_unmap_hpte(kvm, idx, memslot, rmapp, gfn);
- unlock_rmap(rmapp);
- }
- srcu_read_unlock(&kvm->srcu, srcu_idx);
- }
- /* Reload PTE after unmap */
- vpte = be64_to_cpu(hptep[0]);
- BUG_ON(vpte & HPTE_V_VALID);
- BUG_ON(!(vpte & HPTE_V_ABSENT));
- ret = 0;
- if (!(vpte & HPTE_V_BOLTED))
- goto out;
- rpte = be64_to_cpu(hptep[1]);
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- vpte = hpte_new_to_old_v(vpte, rpte);
- rpte = hpte_new_to_old_r(rpte);
- }
- pshift = kvmppc_hpte_base_page_shift(vpte, rpte);
- avpn = HPTE_V_AVPN_VAL(vpte) & ~(((1ul << pshift) - 1) >> 23);
- pteg = idx / HPTES_PER_GROUP;
- if (vpte & HPTE_V_SECONDARY)
- pteg = ~pteg;
- if (!(vpte & HPTE_V_1TB_SEG)) {
- unsigned long offset, vsid;
- /* We only have 28 - 23 bits of offset in avpn */
- offset = (avpn & 0x1f) << 23;
- vsid = avpn >> 5;
- /* We can find more bits from the pteg value */
- if (pshift < 23)
- offset |= ((vsid ^ pteg) & old_hash_mask) << pshift;
- hash = vsid ^ (offset >> pshift);
- } else {
- unsigned long offset, vsid;
- /* We only have 40 - 23 bits of seg_off in avpn */
- offset = (avpn & 0x1ffff) << 23;
- vsid = avpn >> 17;
- if (pshift < 23)
- offset |= ((vsid ^ (vsid << 25) ^ pteg) & old_hash_mask) << pshift;
- hash = vsid ^ (vsid << 25) ^ (offset >> pshift);
- }
- new_pteg = hash & new_hash_mask;
- if (vpte & HPTE_V_SECONDARY)
- new_pteg = ~hash & new_hash_mask;
- new_idx = new_pteg * HPTES_PER_GROUP + (idx % HPTES_PER_GROUP);
- new_hptep = (__be64 *)(new->virt + (new_idx << 4));
- replace_vpte = be64_to_cpu(new_hptep[0]);
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- unsigned long replace_rpte = be64_to_cpu(new_hptep[1]);
- replace_vpte = hpte_new_to_old_v(replace_vpte, replace_rpte);
- }
- if (replace_vpte & (HPTE_V_VALID | HPTE_V_ABSENT)) {
- BUG_ON(new->order >= old->order);
- if (replace_vpte & HPTE_V_BOLTED) {
- if (vpte & HPTE_V_BOLTED)
- /* Bolted collision, nothing we can do */
- ret = -ENOSPC;
- /* Discard the new HPTE */
- goto out;
- }
- /* Discard the previous HPTE */
- }
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- rpte = hpte_old_to_new_r(vpte, rpte);
- vpte = hpte_old_to_new_v(vpte);
- }
- new_hptep[1] = cpu_to_be64(rpte);
- new->rev[new_idx].guest_rpte = guest_rpte;
- /* No need for a barrier, since new HPT isn't active */
- new_hptep[0] = cpu_to_be64(vpte);
- unlock_hpte(new_hptep, vpte);
- out:
- unlock_hpte(hptep, vpte);
- return ret;
- }
- static int resize_hpt_rehash(struct kvm_resize_hpt *resize)
- {
- struct kvm *kvm = resize->kvm;
- unsigned long i;
- int rc;
- for (i = 0; i < kvmppc_hpt_npte(&kvm->arch.hpt); i++) {
- rc = resize_hpt_rehash_hpte(resize, i);
- if (rc != 0)
- return rc;
- }
- return 0;
- }
- static void resize_hpt_pivot(struct kvm_resize_hpt *resize)
- {
- struct kvm *kvm = resize->kvm;
- struct kvm_hpt_info hpt_tmp;
- /* Exchange the pending tables in the resize structure with
- * the active tables */
- resize_hpt_debug(resize, "resize_hpt_pivot()\n");
- spin_lock(&kvm->mmu_lock);
- asm volatile("ptesync" : : : "memory");
- hpt_tmp = kvm->arch.hpt;
- kvmppc_set_hpt(kvm, &resize->hpt);
- resize->hpt = hpt_tmp;
- spin_unlock(&kvm->mmu_lock);
- synchronize_srcu_expedited(&kvm->srcu);
- if (cpu_has_feature(CPU_FTR_ARCH_300))
- kvmppc_setup_partition_table(kvm);
- resize_hpt_debug(resize, "resize_hpt_pivot() done\n");
- }
- static void resize_hpt_release(struct kvm *kvm, struct kvm_resize_hpt *resize)
- {
- if (WARN_ON(!mutex_is_locked(&kvm->lock)))
- return;
- if (!resize)
- return;
- if (resize->error != -EBUSY) {
- if (resize->hpt.virt)
- kvmppc_free_hpt(&resize->hpt);
- kfree(resize);
- }
- if (kvm->arch.resize_hpt == resize)
- kvm->arch.resize_hpt = NULL;
- }
- static void resize_hpt_prepare_work(struct work_struct *work)
- {
- struct kvm_resize_hpt *resize = container_of(work,
- struct kvm_resize_hpt,
- work);
- struct kvm *kvm = resize->kvm;
- int err = 0;
- if (WARN_ON(resize->error != -EBUSY))
- return;
- mutex_lock(&kvm->lock);
- /* Request is still current? */
- if (kvm->arch.resize_hpt == resize) {
- /* We may request large allocations here:
- * do not sleep with kvm->lock held for a while.
- */
- mutex_unlock(&kvm->lock);
- resize_hpt_debug(resize, "resize_hpt_prepare_work(): order = %d\n",
- resize->order);
- err = resize_hpt_allocate(resize);
- /* We have strict assumption about -EBUSY
- * when preparing for HPT resize.
- */
- if (WARN_ON(err == -EBUSY))
- err = -EINPROGRESS;
- mutex_lock(&kvm->lock);
- /* It is possible that kvm->arch.resize_hpt != resize
- * after we grab kvm->lock again.
- */
- }
- resize->error = err;
- if (kvm->arch.resize_hpt != resize)
- resize_hpt_release(kvm, resize);
- mutex_unlock(&kvm->lock);
- }
- long kvm_vm_ioctl_resize_hpt_prepare(struct kvm *kvm,
- struct kvm_ppc_resize_hpt *rhpt)
- {
- unsigned long flags = rhpt->flags;
- unsigned long shift = rhpt->shift;
- struct kvm_resize_hpt *resize;
- int ret;
- if (flags != 0 || kvm_is_radix(kvm))
- return -EINVAL;
- if (shift && ((shift < 18) || (shift > 46)))
- return -EINVAL;
- mutex_lock(&kvm->lock);
- resize = kvm->arch.resize_hpt;
- if (resize) {
- if (resize->order == shift) {
- /* Suitable resize in progress? */
- ret = resize->error;
- if (ret == -EBUSY)
- ret = 100; /* estimated time in ms */
- else if (ret)
- resize_hpt_release(kvm, resize);
- goto out;
- }
- /* not suitable, cancel it */
- resize_hpt_release(kvm, resize);
- }
- ret = 0;
- if (!shift)
- goto out; /* nothing to do */
- /* start new resize */
- resize = kzalloc(sizeof(*resize), GFP_KERNEL);
- if (!resize) {
- ret = -ENOMEM;
- goto out;
- }
- resize->error = -EBUSY;
- resize->order = shift;
- resize->kvm = kvm;
- INIT_WORK(&resize->work, resize_hpt_prepare_work);
- kvm->arch.resize_hpt = resize;
- schedule_work(&resize->work);
- ret = 100; /* estimated time in ms */
- out:
- mutex_unlock(&kvm->lock);
- return ret;
- }
- static void resize_hpt_boot_vcpu(void *opaque)
- {
- /* Nothing to do, just force a KVM exit */
- }
- long kvm_vm_ioctl_resize_hpt_commit(struct kvm *kvm,
- struct kvm_ppc_resize_hpt *rhpt)
- {
- unsigned long flags = rhpt->flags;
- unsigned long shift = rhpt->shift;
- struct kvm_resize_hpt *resize;
- long ret;
- if (flags != 0 || kvm_is_radix(kvm))
- return -EINVAL;
- if (shift && ((shift < 18) || (shift > 46)))
- return -EINVAL;
- mutex_lock(&kvm->lock);
- resize = kvm->arch.resize_hpt;
- /* This shouldn't be possible */
- ret = -EIO;
- if (WARN_ON(!kvm->arch.mmu_ready))
- goto out_no_hpt;
- /* Stop VCPUs from running while we mess with the HPT */
- kvm->arch.mmu_ready = 0;
- smp_mb();
- /* Boot all CPUs out of the guest so they re-read
- * mmu_ready */
- on_each_cpu(resize_hpt_boot_vcpu, NULL, 1);
- ret = -ENXIO;
- if (!resize || (resize->order != shift))
- goto out;
- ret = resize->error;
- if (ret)
- goto out;
- ret = resize_hpt_rehash(resize);
- if (ret)
- goto out;
- resize_hpt_pivot(resize);
- out:
- /* Let VCPUs run again */
- kvm->arch.mmu_ready = 1;
- smp_mb();
- out_no_hpt:
- resize_hpt_release(kvm, resize);
- mutex_unlock(&kvm->lock);
- return ret;
- }
- /*
- * Functions for reading and writing the hash table via reads and
- * writes on a file descriptor.
- *
- * Reads return the guest view of the hash table, which has to be
- * pieced together from the real hash table and the guest_rpte
- * values in the revmap array.
- *
- * On writes, each HPTE written is considered in turn, and if it
- * is valid, it is written to the HPT as if an H_ENTER with the
- * exact flag set was done. When the invalid count is non-zero
- * in the header written to the stream, the kernel will make
- * sure that that many HPTEs are invalid, and invalidate them
- * if not.
- */
- struct kvm_htab_ctx {
- unsigned long index;
- unsigned long flags;
- struct kvm *kvm;
- int first_pass;
- };
- #define HPTE_SIZE (2 * sizeof(unsigned long))
- /*
- * Returns 1 if this HPT entry has been modified or has pending
- * R/C bit changes.
- */
- static int hpte_dirty(struct revmap_entry *revp, __be64 *hptp)
- {
- unsigned long rcbits_unset;
- if (revp->guest_rpte & HPTE_GR_MODIFIED)
- return 1;
- /* Also need to consider changes in reference and changed bits */
- rcbits_unset = ~revp->guest_rpte & (HPTE_R_R | HPTE_R_C);
- if ((be64_to_cpu(hptp[0]) & HPTE_V_VALID) &&
- (be64_to_cpu(hptp[1]) & rcbits_unset))
- return 1;
- return 0;
- }
- static long record_hpte(unsigned long flags, __be64 *hptp,
- unsigned long *hpte, struct revmap_entry *revp,
- int want_valid, int first_pass)
- {
- unsigned long v, r, hr;
- unsigned long rcbits_unset;
- int ok = 1;
- int valid, dirty;
- /* Unmodified entries are uninteresting except on the first pass */
- dirty = hpte_dirty(revp, hptp);
- if (!first_pass && !dirty)
- return 0;
- valid = 0;
- if (be64_to_cpu(hptp[0]) & (HPTE_V_VALID | HPTE_V_ABSENT)) {
- valid = 1;
- if ((flags & KVM_GET_HTAB_BOLTED_ONLY) &&
- !(be64_to_cpu(hptp[0]) & HPTE_V_BOLTED))
- valid = 0;
- }
- if (valid != want_valid)
- return 0;
- v = r = 0;
- if (valid || dirty) {
- /* lock the HPTE so it's stable and read it */
- preempt_disable();
- while (!try_lock_hpte(hptp, HPTE_V_HVLOCK))
- cpu_relax();
- v = be64_to_cpu(hptp[0]);
- hr = be64_to_cpu(hptp[1]);
- if (cpu_has_feature(CPU_FTR_ARCH_300)) {
- v = hpte_new_to_old_v(v, hr);
- hr = hpte_new_to_old_r(hr);
- }
- /* re-evaluate valid and dirty from synchronized HPTE value */
- valid = !!(v & HPTE_V_VALID);
- dirty = !!(revp->guest_rpte & HPTE_GR_MODIFIED);
- /* Harvest R and C into guest view if necessary */
- rcbits_unset = ~revp->guest_rpte & (HPTE_R_R | HPTE_R_C);
- if (valid && (rcbits_unset & hr)) {
- revp->guest_rpte |= (hr &
- (HPTE_R_R | HPTE_R_C)) | HPTE_GR_MODIFIED;
- dirty = 1;
- }
- if (v & HPTE_V_ABSENT) {
- v &= ~HPTE_V_ABSENT;
- v |= HPTE_V_VALID;
- valid = 1;
- }
- if ((flags & KVM_GET_HTAB_BOLTED_ONLY) && !(v & HPTE_V_BOLTED))
- valid = 0;
- r = revp->guest_rpte;
- /* only clear modified if this is the right sort of entry */
- if (valid == want_valid && dirty) {
- r &= ~HPTE_GR_MODIFIED;
- revp->guest_rpte = r;
- }
- unlock_hpte(hptp, be64_to_cpu(hptp[0]));
- preempt_enable();
- if (!(valid == want_valid && (first_pass || dirty)))
- ok = 0;
- }
- hpte[0] = cpu_to_be64(v);
- hpte[1] = cpu_to_be64(r);
- return ok;
- }
- static ssize_t kvm_htab_read(struct file *file, char __user *buf,
- size_t count, loff_t *ppos)
- {
- struct kvm_htab_ctx *ctx = file->private_data;
- struct kvm *kvm = ctx->kvm;
- struct kvm_get_htab_header hdr;
- __be64 *hptp;
- struct revmap_entry *revp;
- unsigned long i, nb, nw;
- unsigned long __user *lbuf;
- struct kvm_get_htab_header __user *hptr;
- unsigned long flags;
- int first_pass;
- unsigned long hpte[2];
- if (!access_ok(VERIFY_WRITE, buf, count))
- return -EFAULT;
- if (kvm_is_radix(kvm))
- return 0;
- first_pass = ctx->first_pass;
- flags = ctx->flags;
- i = ctx->index;
- hptp = (__be64 *)(kvm->arch.hpt.virt + (i * HPTE_SIZE));
- revp = kvm->arch.hpt.rev + i;
- lbuf = (unsigned long __user *)buf;
- nb = 0;
- while (nb + sizeof(hdr) + HPTE_SIZE < count) {
- /* Initialize header */
- hptr = (struct kvm_get_htab_header __user *)buf;
- hdr.n_valid = 0;
- hdr.n_invalid = 0;
- nw = nb;
- nb += sizeof(hdr);
- lbuf = (unsigned long __user *)(buf + sizeof(hdr));
- /* Skip uninteresting entries, i.e. clean on not-first pass */
- if (!first_pass) {
- while (i < kvmppc_hpt_npte(&kvm->arch.hpt) &&
- !hpte_dirty(revp, hptp)) {
- ++i;
- hptp += 2;
- ++revp;
- }
- }
- hdr.index = i;
- /* Grab a series of valid entries */
- while (i < kvmppc_hpt_npte(&kvm->arch.hpt) &&
- hdr.n_valid < 0xffff &&
- nb + HPTE_SIZE < count &&
- record_hpte(flags, hptp, hpte, revp, 1, first_pass)) {
- /* valid entry, write it out */
- ++hdr.n_valid;
- if (__put_user(hpte[0], lbuf) ||
- __put_user(hpte[1], lbuf + 1))
- return -EFAULT;
- nb += HPTE_SIZE;
- lbuf += 2;
- ++i;
- hptp += 2;
- ++revp;
- }
- /* Now skip invalid entries while we can */
- while (i < kvmppc_hpt_npte(&kvm->arch.hpt) &&
- hdr.n_invalid < 0xffff &&
- record_hpte(flags, hptp, hpte, revp, 0, first_pass)) {
- /* found an invalid entry */
- ++hdr.n_invalid;
- ++i;
- hptp += 2;
- ++revp;
- }
- if (hdr.n_valid || hdr.n_invalid) {
- /* write back the header */
- if (__copy_to_user(hptr, &hdr, sizeof(hdr)))
- return -EFAULT;
- nw = nb;
- buf = (char __user *)lbuf;
- } else {
- nb = nw;
- }
- /* Check if we've wrapped around the hash table */
- if (i >= kvmppc_hpt_npte(&kvm->arch.hpt)) {
- i = 0;
- ctx->first_pass = 0;
- break;
- }
- }
- ctx->index = i;
- return nb;
- }
- static ssize_t kvm_htab_write(struct file *file, const char __user *buf,
- size_t count, loff_t *ppos)
- {
- struct kvm_htab_ctx *ctx = file->private_data;
- struct kvm *kvm = ctx->kvm;
- struct kvm_get_htab_header hdr;
- unsigned long i, j;
- unsigned long v, r;
- unsigned long __user *lbuf;
- __be64 *hptp;
- unsigned long tmp[2];
- ssize_t nb;
- long int err, ret;
- int mmu_ready;
- int pshift;
- if (!access_ok(VERIFY_READ, buf, count))
- return -EFAULT;
- if (kvm_is_radix(kvm))
- return -EINVAL;
- /* lock out vcpus from running while we're doing this */
- mutex_lock(&kvm->lock);
- mmu_ready = kvm->arch.mmu_ready;
- if (mmu_ready) {
- kvm->arch.mmu_ready = 0; /* temporarily */
- /* order mmu_ready vs. vcpus_running */
- smp_mb();
- if (atomic_read(&kvm->arch.vcpus_running)) {
- kvm->arch.mmu_ready = 1;
- mutex_unlock(&kvm->lock);
- return -EBUSY;
- }
- }
- err = 0;
- for (nb = 0; nb + sizeof(hdr) <= count; ) {
- err = -EFAULT;
- if (__copy_from_user(&hdr, buf, sizeof(hdr)))
- break;
- err = 0;
- if (nb + hdr.n_valid * HPTE_SIZE > count)
- break;
- nb += sizeof(hdr);
- buf += sizeof(hdr);
- err = -EINVAL;
- i = hdr.index;
- if (i >= kvmppc_hpt_npte(&kvm->arch.hpt) ||
- i + hdr.n_valid + hdr.n_invalid > kvmppc_hpt_npte(&kvm->arch.hpt))
- break;
- hptp = (__be64 *)(kvm->arch.hpt.virt + (i * HPTE_SIZE));
- lbuf = (unsigned long __user *)buf;
- for (j = 0; j < hdr.n_valid; ++j) {
- __be64 hpte_v;
- __be64 hpte_r;
- err = -EFAULT;
- if (__get_user(hpte_v, lbuf) ||
- __get_user(hpte_r, lbuf + 1))
- goto out;
- v = be64_to_cpu(hpte_v);
- r = be64_to_cpu(hpte_r);
- err = -EINVAL;
- if (!(v & HPTE_V_VALID))
- goto out;
- pshift = kvmppc_hpte_base_page_shift(v, r);
- if (pshift <= 0)
- goto out;
- lbuf += 2;
- nb += HPTE_SIZE;
- if (be64_to_cpu(hptp[0]) & (HPTE_V_VALID | HPTE_V_ABSENT))
- kvmppc_do_h_remove(kvm, 0, i, 0, tmp);
- err = -EIO;
- ret = kvmppc_virtmode_do_h_enter(kvm, H_EXACT, i, v, r,
- tmp);
- if (ret != H_SUCCESS) {
- pr_err("kvm_htab_write ret %ld i=%ld v=%lx "
- "r=%lx\n", ret, i, v, r);
- goto out;
- }
- if (!mmu_ready && is_vrma_hpte(v)) {
- unsigned long senc, lpcr;
- senc = slb_pgsize_encoding(1ul << pshift);
- kvm->arch.vrma_slb_v = senc | SLB_VSID_B_1T |
- (VRMA_VSID << SLB_VSID_SHIFT_1T);
- if (!cpu_has_feature(CPU_FTR_ARCH_300)) {
- lpcr = senc << (LPCR_VRMASD_SH - 4);
- kvmppc_update_lpcr(kvm, lpcr,
- LPCR_VRMASD);
- } else {
- kvmppc_setup_partition_table(kvm);
- }
- mmu_ready = 1;
- }
- ++i;
- hptp += 2;
- }
- for (j = 0; j < hdr.n_invalid; ++j) {
- if (be64_to_cpu(hptp[0]) & (HPTE_V_VALID | HPTE_V_ABSENT))
- kvmppc_do_h_remove(kvm, 0, i, 0, tmp);
- ++i;
- hptp += 2;
- }
- err = 0;
- }
- out:
- /* Order HPTE updates vs. mmu_ready */
- smp_wmb();
- kvm->arch.mmu_ready = mmu_ready;
- mutex_unlock(&kvm->lock);
- if (err)
- return err;
- return nb;
- }
- static int kvm_htab_release(struct inode *inode, struct file *filp)
- {
- struct kvm_htab_ctx *ctx = filp->private_data;
- filp->private_data = NULL;
- if (!(ctx->flags & KVM_GET_HTAB_WRITE))
- atomic_dec(&ctx->kvm->arch.hpte_mod_interest);
- kvm_put_kvm(ctx->kvm);
- kfree(ctx);
- return 0;
- }
- static const struct file_operations kvm_htab_fops = {
- .read = kvm_htab_read,
- .write = kvm_htab_write,
- .llseek = default_llseek,
- .release = kvm_htab_release,
- };
- int kvm_vm_ioctl_get_htab_fd(struct kvm *kvm, struct kvm_get_htab_fd *ghf)
- {
- int ret;
- struct kvm_htab_ctx *ctx;
- int rwflag;
- /* reject flags we don't recognize */
- if (ghf->flags & ~(KVM_GET_HTAB_BOLTED_ONLY | KVM_GET_HTAB_WRITE))
- return -EINVAL;
- ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
- if (!ctx)
- return -ENOMEM;
- kvm_get_kvm(kvm);
- ctx->kvm = kvm;
- ctx->index = ghf->start_index;
- ctx->flags = ghf->flags;
- ctx->first_pass = 1;
- rwflag = (ghf->flags & KVM_GET_HTAB_WRITE) ? O_WRONLY : O_RDONLY;
- ret = anon_inode_getfd("kvm-htab", &kvm_htab_fops, ctx, rwflag | O_CLOEXEC);
- if (ret < 0) {
- kfree(ctx);
- kvm_put_kvm(kvm);
- return ret;
- }
- if (rwflag == O_RDONLY) {
- mutex_lock(&kvm->slots_lock);
- atomic_inc(&kvm->arch.hpte_mod_interest);
- /* make sure kvmppc_do_h_enter etc. see the increment */
- synchronize_srcu_expedited(&kvm->srcu);
- mutex_unlock(&kvm->slots_lock);
- }
- return ret;
- }
- struct debugfs_htab_state {
- struct kvm *kvm;
- struct mutex mutex;
- unsigned long hpt_index;
- int chars_left;
- int buf_index;
- char buf[64];
- };
- static int debugfs_htab_open(struct inode *inode, struct file *file)
- {
- struct kvm *kvm = inode->i_private;
- struct debugfs_htab_state *p;
- p = kzalloc(sizeof(*p), GFP_KERNEL);
- if (!p)
- return -ENOMEM;
- kvm_get_kvm(kvm);
- p->kvm = kvm;
- mutex_init(&p->mutex);
- file->private_data = p;
- return nonseekable_open(inode, file);
- }
- static int debugfs_htab_release(struct inode *inode, struct file *file)
- {
- struct debugfs_htab_state *p = file->private_data;
- kvm_put_kvm(p->kvm);
- kfree(p);
- return 0;
- }
- static ssize_t debugfs_htab_read(struct file *file, char __user *buf,
- size_t len, loff_t *ppos)
- {
- struct debugfs_htab_state *p = file->private_data;
- ssize_t ret, r;
- unsigned long i, n;
- unsigned long v, hr, gr;
- struct kvm *kvm;
- __be64 *hptp;
- kvm = p->kvm;
- if (kvm_is_radix(kvm))
- return 0;
- ret = mutex_lock_interruptible(&p->mutex);
- if (ret)
- return ret;
- if (p->chars_left) {
- n = p->chars_left;
- if (n > len)
- n = len;
- r = copy_to_user(buf, p->buf + p->buf_index, n);
- n -= r;
- p->chars_left -= n;
- p->buf_index += n;
- buf += n;
- len -= n;
- ret = n;
- if (r) {
- if (!n)
- ret = -EFAULT;
- goto out;
- }
- }
- i = p->hpt_index;
- hptp = (__be64 *)(kvm->arch.hpt.virt + (i * HPTE_SIZE));
- for (; len != 0 && i < kvmppc_hpt_npte(&kvm->arch.hpt);
- ++i, hptp += 2) {
- if (!(be64_to_cpu(hptp[0]) & (HPTE_V_VALID | HPTE_V_ABSENT)))
- continue;
- /* lock the HPTE so it's stable and read it */
- preempt_disable();
- while (!try_lock_hpte(hptp, HPTE_V_HVLOCK))
- cpu_relax();
- v = be64_to_cpu(hptp[0]) & ~HPTE_V_HVLOCK;
- hr = be64_to_cpu(hptp[1]);
- gr = kvm->arch.hpt.rev[i].guest_rpte;
- unlock_hpte(hptp, v);
- preempt_enable();
- if (!(v & (HPTE_V_VALID | HPTE_V_ABSENT)))
- continue;
- n = scnprintf(p->buf, sizeof(p->buf),
- "%6lx %.16lx %.16lx %.16lx\n",
- i, v, hr, gr);
- p->chars_left = n;
- if (n > len)
- n = len;
- r = copy_to_user(buf, p->buf, n);
- n -= r;
- p->chars_left -= n;
- p->buf_index = n;
- buf += n;
- len -= n;
- ret += n;
- if (r) {
- if (!ret)
- ret = -EFAULT;
- goto out;
- }
- }
- p->hpt_index = i;
- out:
- mutex_unlock(&p->mutex);
- return ret;
- }
- static ssize_t debugfs_htab_write(struct file *file, const char __user *buf,
- size_t len, loff_t *ppos)
- {
- return -EACCES;
- }
- static const struct file_operations debugfs_htab_fops = {
- .owner = THIS_MODULE,
- .open = debugfs_htab_open,
- .release = debugfs_htab_release,
- .read = debugfs_htab_read,
- .write = debugfs_htab_write,
- .llseek = generic_file_llseek,
- };
- void kvmppc_mmu_debugfs_init(struct kvm *kvm)
- {
- kvm->arch.htab_dentry = debugfs_create_file("htab", 0400,
- kvm->arch.debugfs_dir, kvm,
- &debugfs_htab_fops);
- }
- void kvmppc_mmu_book3s_hv_init(struct kvm_vcpu *vcpu)
- {
- struct kvmppc_mmu *mmu = &vcpu->arch.mmu;
- vcpu->arch.slb_nr = 32; /* POWER7/POWER8 */
- mmu->xlate = kvmppc_mmu_book3s_64_hv_xlate;
- mmu->reset_msr = kvmppc_mmu_book3s_64_hv_reset_msr;
- vcpu->arch.hflags |= BOOK3S_HFLAG_SLB;
- }
|