/* * kvm_vcpu.c: handling all virtual cpu related thing. * Copyright (c) 2005, Intel Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms and conditions of the GNU General Public License, * version 2, as published by the Free Software Foundation. * * This program is distributed in the hope 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, Inc., 59 Temple * Place - Suite 330, Boston, MA 02111-1307 USA. * * Shaofan Li (Susue Li) <susie.li@intel.com> * Yaozu Dong (Eddie Dong) (Eddie.dong@intel.com) * Xuefei Xu (Anthony Xu) (Anthony.xu@intel.com) * Xiantao Zhang <xiantao.zhang@intel.com> */ #include <linux/kvm_host.h> #include <linux/types.h> #include <asm/processor.h> #include <asm/ia64regs.h> #include <asm/gcc_intrin.h> #include <asm/kregs.h> #include <asm/pgtable.h> #include <asm/tlb.h> #include "asm-offsets.h" #include "vcpu.h" /* * Special notes: * - Index by it/dt/rt sequence * - Only existing mode transitions are allowed in this table * - RSE is placed at lazy mode when emulating guest partial mode * - If gva happens to be rr0 and rr4, only allowed case is identity * mapping (gva=gpa), or panic! (How?) */ int mm_switch_table[8][8] = { /* 2004/09/12(Kevin): Allow switch to self */ /* * (it,dt,rt): (0,0,0) -> (1,1,1) * This kind of transition usually occurs in the very early * stage of Linux boot up procedure. Another case is in efi * and pal calls. (see "arch/ia64/kernel/head.S") * * (it,dt,rt): (0,0,0) -> (0,1,1) * This kind of transition is found when OSYa exits efi boot * service. Due to gva = gpa in this case (Same region), * data access can be satisfied though itlb entry for physical * emulation is hit. */ {SW_SELF, 0, 0, SW_NOP, 0, 0, 0, SW_P2V}, {0, 0, 0, 0, 0, 0, 0, 0}, {0, 0, 0, 0, 0, 0, 0, 0}, /* * (it,dt,rt): (0,1,1) -> (1,1,1) * This kind of transition is found in OSYa. * * (it,dt,rt): (0,1,1) -> (0,0,0) * This kind of transition is found in OSYa */ {SW_NOP, 0, 0, SW_SELF, 0, 0, 0, SW_P2V}, /* (1,0,0)->(1,1,1) */ {0, 0, 0, 0, 0, 0, 0, SW_P2V}, /* * (it,dt,rt): (1,0,1) -> (1,1,1) * This kind of transition usually occurs when Linux returns * from the low level TLB miss handlers. * (see "arch/ia64/kernel/ivt.S") */ {0, 0, 0, 0, 0, SW_SELF, 0, SW_P2V}, {0, 0, 0, 0, 0, 0, 0, 0}, /* * (it,dt,rt): (1,1,1) -> (1,0,1) * This kind of transition usually occurs in Linux low level * TLB miss handler. (see "arch/ia64/kernel/ivt.S") * * (it,dt,rt): (1,1,1) -> (0,0,0) * This kind of transition usually occurs in pal and efi calls, * which requires running in physical mode. * (see "arch/ia64/kernel/head.S") * (1,1,1)->(1,0,0) */ {SW_V2P, 0, 0, 0, SW_V2P, SW_V2P, 0, SW_SELF}, }; void physical_mode_init(struct kvm_vcpu *vcpu) { vcpu->arch.mode_flags = GUEST_IN_PHY; } void switch_to_physical_rid(struct kvm_vcpu *vcpu) { unsigned long psr; /* Save original virtual mode rr[0] and rr[4] */ psr = ia64_clear_ic(); ia64_set_rr(VRN0<<VRN_SHIFT, vcpu->arch.metaphysical_rr0); ia64_srlz_d(); ia64_set_rr(VRN4<<VRN_SHIFT, vcpu->arch.metaphysical_rr4); ia64_srlz_d(); ia64_set_psr(psr); return; } void switch_to_virtual_rid(struct kvm_vcpu *vcpu) { unsigned long psr; psr = ia64_clear_ic(); ia64_set_rr(VRN0 << VRN_SHIFT, vcpu->arch.metaphysical_saved_rr0); ia64_srlz_d(); ia64_set_rr(VRN4 << VRN_SHIFT, vcpu->arch.metaphysical_saved_rr4); ia64_srlz_d(); ia64_set_psr(psr); return; } static int mm_switch_action(struct ia64_psr opsr, struct ia64_psr npsr) { return mm_switch_table[MODE_IND(opsr)][MODE_IND(npsr)]; } void switch_mm_mode(struct kvm_vcpu *vcpu, struct ia64_psr old_psr, struct ia64_psr new_psr) { int act; act = mm_switch_action(old_psr, new_psr); switch (act) { case SW_V2P: /*printk("V -> P mode transition: (0x%lx -> 0x%lx)\n", old_psr.val, new_psr.val);*/ switch_to_physical_rid(vcpu); /* * Set rse to enforced lazy, to prevent active rse *save/restor when guest physical mode. */ vcpu->arch.mode_flags |= GUEST_IN_PHY; break; case SW_P2V: switch_to_virtual_rid(vcpu); /* * recover old mode which is saved when entering * guest physical mode */ vcpu->arch.mode_flags &= ~GUEST_IN_PHY; break; case SW_SELF: break; case SW_NOP: break; default: /* Sanity check */ break; } return; } /* * In physical mode, insert tc/tr for region 0 and 4 uses * RID[0] and RID[4] which is for physical mode emulation. * However what those inserted tc/tr wants is rid for * virtual mode. So original virtual rid needs to be restored * before insert. * * Operations which required such switch include: * - insertions (itc.*, itr.*) * - purges (ptc.* and ptr.*) * - tpa * - tak * - thash?, ttag? * All above needs actual virtual rid for destination entry. */ void check_mm_mode_switch(struct kvm_vcpu *vcpu, struct ia64_psr old_psr, struct ia64_psr new_psr) { if ((old_psr.dt != new_psr.dt) || (old_psr.it != new_psr.it) || (old_psr.rt != new_psr.rt)) switch_mm_mode(vcpu, old_psr, new_psr); return; } /* * In physical mode, insert tc/tr for region 0 and 4 uses * RID[0] and RID[4] which is for physical mode emulation. * However what those inserted tc/tr wants is rid for * virtual mode. So original virtual rid needs to be restored * before insert. * * Operations which required such switch include: * - insertions (itc.*, itr.*) * - purges (ptc.* and ptr.*) * - tpa * - tak * - thash?, ttag? * All above needs actual virtual rid for destination entry. */ void prepare_if_physical_mode(struct kvm_vcpu *vcpu) { if (is_physical_mode(vcpu)) { vcpu->arch.mode_flags |= GUEST_PHY_EMUL; switch_to_virtual_rid(vcpu); } return; } /* Recover always follows prepare */ void recover_if_physical_mode(struct kvm_vcpu *vcpu) { if (is_physical_mode(vcpu)) switch_to_physical_rid(vcpu); vcpu->arch.mode_flags &= ~GUEST_PHY_EMUL; return; } #define RPT(x) ((u16) &((struct kvm_pt_regs *)0)->x) static u16 gr_info[32] = { 0, /* r0 is read-only : WE SHOULD NEVER GET THIS */ RPT(r1), RPT(r2), RPT(r3), RPT(r4), RPT(r5), RPT(r6), RPT(r7), RPT(r8), RPT(r9), RPT(r10), RPT(r11), RPT(r12), RPT(r13), RPT(r14), RPT(r15), RPT(r16), RPT(r17), RPT(r18), RPT(r19), RPT(r20), RPT(r21), RPT(r22), RPT(r23), RPT(r24), RPT(r25), RPT(r26), RPT(r27), RPT(r28), RPT(r29), RPT(r30), RPT(r31) }; #define IA64_FIRST_STACKED_GR 32 #define IA64_FIRST_ROTATING_FR 32 static inline unsigned long rotate_reg(unsigned long sor, unsigned long rrb, unsigned long reg) { reg += rrb; if (reg >= sor) reg -= sor; return reg; } /* * Return the (rotated) index for floating point register * be in the REGNUM (REGNUM must range from 32-127, * result is in the range from 0-95. */ static inline unsigned long fph_index(struct kvm_pt_regs *regs, long regnum) { unsigned long rrb_fr = (regs->cr_ifs >> 25) & 0x7f; return rotate_reg(96, rrb_fr, (regnum - IA64_FIRST_ROTATING_FR)); } /* * The inverse of the above: given bspstore and the number of * registers, calculate ar.bsp. */ static inline unsigned long *kvm_rse_skip_regs(unsigned long *addr, long num_regs) { long delta = ia64_rse_slot_num(addr) + num_regs; int i = 0; if (num_regs < 0) delta -= 0x3e; if (delta < 0) { while (delta <= -0x3f) { i--; delta += 0x3f; } } else { while (delta >= 0x3f) { i++; delta -= 0x3f; } } return addr + num_regs + i; } static void get_rse_reg(struct kvm_pt_regs *regs, unsigned long r1, unsigned long *val, int *nat) { unsigned long *bsp, *addr, *rnat_addr, *bspstore; unsigned long *kbs = (void *) current_vcpu + VMM_RBS_OFFSET; unsigned long nat_mask; unsigned long old_rsc, new_rsc; long sof = (regs->cr_ifs) & 0x7f; long sor = (((regs->cr_ifs >> 14) & 0xf) << 3); long rrb_gr = (regs->cr_ifs >> 18) & 0x7f; long ridx = r1 - 32; if (ridx < sor) ridx = rotate_reg(sor, rrb_gr, ridx); old_rsc = ia64_getreg(_IA64_REG_AR_RSC); new_rsc = old_rsc&(~(0x3)); ia64_setreg(_IA64_REG_AR_RSC, new_rsc); bspstore = (unsigned long *)ia64_getreg(_IA64_REG_AR_BSPSTORE); bsp = kbs + (regs->loadrs >> 19); addr = kvm_rse_skip_regs(bsp, -sof + ridx); nat_mask = 1UL << ia64_rse_slot_num(addr); rnat_addr = ia64_rse_rnat_addr(addr); if (addr >= bspstore) { ia64_flushrs(); ia64_mf(); bspstore = (unsigned long *)ia64_getreg(_IA64_REG_AR_BSPSTORE); } *val = *addr; if (nat) { if (bspstore < rnat_addr) *nat = (int)!!(ia64_getreg(_IA64_REG_AR_RNAT) & nat_mask); else *nat = (int)!!((*rnat_addr) & nat_mask); ia64_setreg(_IA64_REG_AR_RSC, old_rsc); } } void set_rse_reg(struct kvm_pt_regs *regs, unsigned long r1, unsigned long val, unsigned long nat) { unsigned long *bsp, *bspstore, *addr, *rnat_addr; unsigned long *kbs = (void *) current_vcpu + VMM_RBS_OFFSET; unsigned long nat_mask; unsigned long old_rsc, new_rsc, psr; unsigned long rnat; long sof = (regs->cr_ifs) & 0x7f; long sor = (((regs->cr_ifs >> 14) & 0xf) << 3); long rrb_gr = (regs->cr_ifs >> 18) & 0x7f; long ridx = r1 - 32; if (ridx < sor) ridx = rotate_reg(sor, rrb_gr, ridx); old_rsc = ia64_getreg(_IA64_REG_AR_RSC); /* put RSC to lazy mode, and set loadrs 0 */ new_rsc = old_rsc & (~0x3fff0003); ia64_setreg(_IA64_REG_AR_RSC, new_rsc); bsp = kbs + (regs->loadrs >> 19); /* 16 + 3 */ addr = kvm_rse_skip_regs(bsp, -sof + ridx); nat_mask = 1UL << ia64_rse_slot_num(addr); rnat_addr = ia64_rse_rnat_addr(addr); local_irq_save(psr); bspstore = (unsigned long *)ia64_getreg(_IA64_REG_AR_BSPSTORE); if (addr >= bspstore) { ia64_flushrs(); ia64_mf(); *addr = val; bspstore = (unsigned long *)ia64_getreg(_IA64_REG_AR_BSPSTORE); rnat = ia64_getreg(_IA64_REG_AR_RNAT); if (bspstore < rnat_addr) rnat = rnat & (~nat_mask); else *rnat_addr = (*rnat_addr)&(~nat_mask); ia64_mf(); ia64_loadrs(); ia64_setreg(_IA64_REG_AR_RNAT, rnat); } else { rnat = ia64_getreg(_IA64_REG_AR_RNAT); *addr = val; if (bspstore < rnat_addr) rnat = rnat&(~nat_mask); else *rnat_addr = (*rnat_addr) & (~nat_mask); ia64_setreg(_IA64_REG_AR_BSPSTORE, (unsigned long)bspstore); ia64_setreg(_IA64_REG_AR_RNAT, rnat); } local_irq_restore(psr); ia64_setreg(_IA64_REG_AR_RSC, old_rsc); } void getreg(unsigned long regnum, unsigned long *val, int *nat, struct kvm_pt_regs *regs) { unsigned long addr, *unat; if (regnum >= IA64_FIRST_STACKED_GR) { get_rse_reg(regs, regnum, val, nat); return; } /* * Now look at registers in [0-31] range and init correct UNAT */ addr = (unsigned long)regs; unat = ®s->eml_unat; addr += gr_info[regnum]; *val = *(unsigned long *)addr; /* * do it only when requested */ if (nat) *nat = (*unat >> ((addr >> 3) & 0x3f)) & 0x1UL; } void setreg(unsigned long regnum, unsigned long val, int nat, struct kvm_pt_regs *regs) { unsigned long addr; unsigned long bitmask; unsigned long *unat; /* * First takes care of stacked registers */ if (regnum >= IA64_FIRST_STACKED_GR) { set_rse_reg(regs, regnum, val, nat); return; } /* * Now look at registers in [0-31] range and init correct UNAT */ addr = (unsigned long)regs; unat = ®s->eml_unat; /* * add offset from base of struct * and do it ! */ addr += gr_info[regnum]; *(unsigned long *)addr = val; /* * We need to clear the corresponding UNAT bit to fully emulate the load * UNAT bit_pos = GR[r3]{8:3} form EAS-2.4 */ bitmask = 1UL << ((addr >> 3) & 0x3f); if (nat) *unat |= bitmask; else *unat &= ~bitmask; } u64 vcpu_get_gr(struct kvm_vcpu *vcpu, unsigned long reg) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); unsigned long val; if (!reg) return 0; getreg(reg, &val, 0, regs); return val; } void vcpu_set_gr(struct kvm_vcpu *vcpu, unsigned long reg, u64 value, int nat) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); long sof = (regs->cr_ifs) & 0x7f; if (!reg) return; if (reg >= sof + 32) return; setreg(reg, value, nat, regs); /* FIXME: handle NATs later*/ } void getfpreg(unsigned long regnum, struct ia64_fpreg *fpval, struct kvm_pt_regs *regs) { /* Take floating register rotation into consideration*/ if (regnum >= IA64_FIRST_ROTATING_FR) regnum = IA64_FIRST_ROTATING_FR + fph_index(regs, regnum); #define CASE_FIXED_FP(reg) \ case (reg) : \ ia64_stf_spill(fpval, reg); \ break switch (regnum) { CASE_FIXED_FP(0); CASE_FIXED_FP(1); CASE_FIXED_FP(2); CASE_FIXED_FP(3); CASE_FIXED_FP(4); CASE_FIXED_FP(5); CASE_FIXED_FP(6); CASE_FIXED_FP(7); CASE_FIXED_FP(8); CASE_FIXED_FP(9); CASE_FIXED_FP(10); CASE_FIXED_FP(11); CASE_FIXED_FP(12); CASE_FIXED_FP(13); CASE_FIXED_FP(14); CASE_FIXED_FP(15); CASE_FIXED_FP(16); CASE_FIXED_FP(17); CASE_FIXED_FP(18); CASE_FIXED_FP(19); CASE_FIXED_FP(20); CASE_FIXED_FP(21); CASE_FIXED_FP(22); CASE_FIXED_FP(23); CASE_FIXED_FP(24); CASE_FIXED_FP(25); CASE_FIXED_FP(26); CASE_FIXED_FP(27); CASE_FIXED_FP(28); CASE_FIXED_FP(29); CASE_FIXED_FP(30); CASE_FIXED_FP(31); CASE_FIXED_FP(32); CASE_FIXED_FP(33); CASE_FIXED_FP(34); CASE_FIXED_FP(35); CASE_FIXED_FP(36); CASE_FIXED_FP(37); CASE_FIXED_FP(38); CASE_FIXED_FP(39); CASE_FIXED_FP(40); CASE_FIXED_FP(41); CASE_FIXED_FP(42); CASE_FIXED_FP(43); CASE_FIXED_FP(44); CASE_FIXED_FP(45); CASE_FIXED_FP(46); CASE_FIXED_FP(47); CASE_FIXED_FP(48); CASE_FIXED_FP(49); CASE_FIXED_FP(50); CASE_FIXED_FP(51); CASE_FIXED_FP(52); CASE_FIXED_FP(53); CASE_FIXED_FP(54); CASE_FIXED_FP(55); CASE_FIXED_FP(56); CASE_FIXED_FP(57); CASE_FIXED_FP(58); CASE_FIXED_FP(59); CASE_FIXED_FP(60); CASE_FIXED_FP(61); CASE_FIXED_FP(62); CASE_FIXED_FP(63); CASE_FIXED_FP(64); CASE_FIXED_FP(65); CASE_FIXED_FP(66); CASE_FIXED_FP(67); CASE_FIXED_FP(68); CASE_FIXED_FP(69); CASE_FIXED_FP(70); CASE_FIXED_FP(71); CASE_FIXED_FP(72); CASE_FIXED_FP(73); CASE_FIXED_FP(74); CASE_FIXED_FP(75); CASE_FIXED_FP(76); CASE_FIXED_FP(77); CASE_FIXED_FP(78); CASE_FIXED_FP(79); CASE_FIXED_FP(80); CASE_FIXED_FP(81); CASE_FIXED_FP(82); CASE_FIXED_FP(83); CASE_FIXED_FP(84); CASE_FIXED_FP(85); CASE_FIXED_FP(86); CASE_FIXED_FP(87); CASE_FIXED_FP(88); CASE_FIXED_FP(89); CASE_FIXED_FP(90); CASE_FIXED_FP(91); CASE_FIXED_FP(92); CASE_FIXED_FP(93); CASE_FIXED_FP(94); CASE_FIXED_FP(95); CASE_FIXED_FP(96); CASE_FIXED_FP(97); CASE_FIXED_FP(98); CASE_FIXED_FP(99); CASE_FIXED_FP(100); CASE_FIXED_FP(101); CASE_FIXED_FP(102); CASE_FIXED_FP(103); CASE_FIXED_FP(104); CASE_FIXED_FP(105); CASE_FIXED_FP(106); CASE_FIXED_FP(107); CASE_FIXED_FP(108); CASE_FIXED_FP(109); CASE_FIXED_FP(110); CASE_FIXED_FP(111); CASE_FIXED_FP(112); CASE_FIXED_FP(113); CASE_FIXED_FP(114); CASE_FIXED_FP(115); CASE_FIXED_FP(116); CASE_FIXED_FP(117); CASE_FIXED_FP(118); CASE_FIXED_FP(119); CASE_FIXED_FP(120); CASE_FIXED_FP(121); CASE_FIXED_FP(122); CASE_FIXED_FP(123); CASE_FIXED_FP(124); CASE_FIXED_FP(125); CASE_FIXED_FP(126); CASE_FIXED_FP(127); } #undef CASE_FIXED_FP } void setfpreg(unsigned long regnum, struct ia64_fpreg *fpval, struct kvm_pt_regs *regs) { /* Take floating register rotation into consideration*/ if (regnum >= IA64_FIRST_ROTATING_FR) regnum = IA64_FIRST_ROTATING_FR + fph_index(regs, regnum); #define CASE_FIXED_FP(reg) \ case (reg) : \ ia64_ldf_fill(reg, fpval); \ break switch (regnum) { CASE_FIXED_FP(2); CASE_FIXED_FP(3); CASE_FIXED_FP(4); CASE_FIXED_FP(5); CASE_FIXED_FP(6); CASE_FIXED_FP(7); CASE_FIXED_FP(8); CASE_FIXED_FP(9); CASE_FIXED_FP(10); CASE_FIXED_FP(11); CASE_FIXED_FP(12); CASE_FIXED_FP(13); CASE_FIXED_FP(14); CASE_FIXED_FP(15); CASE_FIXED_FP(16); CASE_FIXED_FP(17); CASE_FIXED_FP(18); CASE_FIXED_FP(19); CASE_FIXED_FP(20); CASE_FIXED_FP(21); CASE_FIXED_FP(22); CASE_FIXED_FP(23); CASE_FIXED_FP(24); CASE_FIXED_FP(25); CASE_FIXED_FP(26); CASE_FIXED_FP(27); CASE_FIXED_FP(28); CASE_FIXED_FP(29); CASE_FIXED_FP(30); CASE_FIXED_FP(31); CASE_FIXED_FP(32); CASE_FIXED_FP(33); CASE_FIXED_FP(34); CASE_FIXED_FP(35); CASE_FIXED_FP(36); CASE_FIXED_FP(37); CASE_FIXED_FP(38); CASE_FIXED_FP(39); CASE_FIXED_FP(40); CASE_FIXED_FP(41); CASE_FIXED_FP(42); CASE_FIXED_FP(43); CASE_FIXED_FP(44); CASE_FIXED_FP(45); CASE_FIXED_FP(46); CASE_FIXED_FP(47); CASE_FIXED_FP(48); CASE_FIXED_FP(49); CASE_FIXED_FP(50); CASE_FIXED_FP(51); CASE_FIXED_FP(52); CASE_FIXED_FP(53); CASE_FIXED_FP(54); CASE_FIXED_FP(55); CASE_FIXED_FP(56); CASE_FIXED_FP(57); CASE_FIXED_FP(58); CASE_FIXED_FP(59); CASE_FIXED_FP(60); CASE_FIXED_FP(61); CASE_FIXED_FP(62); CASE_FIXED_FP(63); CASE_FIXED_FP(64); CASE_FIXED_FP(65); CASE_FIXED_FP(66); CASE_FIXED_FP(67); CASE_FIXED_FP(68); CASE_FIXED_FP(69); CASE_FIXED_FP(70); CASE_FIXED_FP(71); CASE_FIXED_FP(72); CASE_FIXED_FP(73); CASE_FIXED_FP(74); CASE_FIXED_FP(75); CASE_FIXED_FP(76); CASE_FIXED_FP(77); CASE_FIXED_FP(78); CASE_FIXED_FP(79); CASE_FIXED_FP(80); CASE_FIXED_FP(81); CASE_FIXED_FP(82); CASE_FIXED_FP(83); CASE_FIXED_FP(84); CASE_FIXED_FP(85); CASE_FIXED_FP(86); CASE_FIXED_FP(87); CASE_FIXED_FP(88); CASE_FIXED_FP(89); CASE_FIXED_FP(90); CASE_FIXED_FP(91); CASE_FIXED_FP(92); CASE_FIXED_FP(93); CASE_FIXED_FP(94); CASE_FIXED_FP(95); CASE_FIXED_FP(96); CASE_FIXED_FP(97); CASE_FIXED_FP(98); CASE_FIXED_FP(99); CASE_FIXED_FP(100); CASE_FIXED_FP(101); CASE_FIXED_FP(102); CASE_FIXED_FP(103); CASE_FIXED_FP(104); CASE_FIXED_FP(105); CASE_FIXED_FP(106); CASE_FIXED_FP(107); CASE_FIXED_FP(108); CASE_FIXED_FP(109); CASE_FIXED_FP(110); CASE_FIXED_FP(111); CASE_FIXED_FP(112); CASE_FIXED_FP(113); CASE_FIXED_FP(114); CASE_FIXED_FP(115); CASE_FIXED_FP(116); CASE_FIXED_FP(117); CASE_FIXED_FP(118); CASE_FIXED_FP(119); CASE_FIXED_FP(120); CASE_FIXED_FP(121); CASE_FIXED_FP(122); CASE_FIXED_FP(123); CASE_FIXED_FP(124); CASE_FIXED_FP(125); CASE_FIXED_FP(126); CASE_FIXED_FP(127); } } void vcpu_get_fpreg(struct kvm_vcpu *vcpu, unsigned long reg, struct ia64_fpreg *val) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); getfpreg(reg, val, regs); /* FIXME: handle NATs later*/ } void vcpu_set_fpreg(struct kvm_vcpu *vcpu, unsigned long reg, struct ia64_fpreg *val) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); if (reg > 1) setfpreg(reg, val, regs); /* FIXME: handle NATs later*/ } /* * The Altix RTC is mapped specially here for the vmm module */ #define SN_RTC_BASE (u64 *)(KVM_VMM_BASE+(1UL<<KVM_VMM_SHIFT)) static long kvm_get_itc(struct kvm_vcpu *vcpu) { #if defined(CONFIG_IA64_SGI_SN2) || defined(CONFIG_IA64_GENERIC) struct kvm *kvm = (struct kvm *)KVM_VM_BASE; if (kvm->arch.is_sn2) return (*SN_RTC_BASE); else #endif return ia64_getreg(_IA64_REG_AR_ITC); } /************************************************************************ * lsapic timer ***********************************************************************/ u64 vcpu_get_itc(struct kvm_vcpu *vcpu) { unsigned long guest_itc; guest_itc = VMX(vcpu, itc_offset) + kvm_get_itc(vcpu); if (guest_itc >= VMX(vcpu, last_itc)) { VMX(vcpu, last_itc) = guest_itc; return guest_itc; } else return VMX(vcpu, last_itc); } static inline void vcpu_set_itm(struct kvm_vcpu *vcpu, u64 val); static void vcpu_set_itc(struct kvm_vcpu *vcpu, u64 val) { struct kvm_vcpu *v; struct kvm *kvm; int i; long itc_offset = val - kvm_get_itc(vcpu); unsigned long vitv = VCPU(vcpu, itv); kvm = (struct kvm *)KVM_VM_BASE; if (kvm_vcpu_is_bsp(vcpu)) { for (i = 0; i < atomic_read(&kvm->online_vcpus); i++) { v = (struct kvm_vcpu *)((char *)vcpu + sizeof(struct kvm_vcpu_data) * i); VMX(v, itc_offset) = itc_offset; VMX(v, last_itc) = 0; } } VMX(vcpu, last_itc) = 0; if (VCPU(vcpu, itm) <= val) { VMX(vcpu, itc_check) = 0; vcpu_unpend_interrupt(vcpu, vitv); } else { VMX(vcpu, itc_check) = 1; vcpu_set_itm(vcpu, VCPU(vcpu, itm)); } } static inline u64 vcpu_get_itm(struct kvm_vcpu *vcpu) { return ((u64)VCPU(vcpu, itm)); } static inline void vcpu_set_itm(struct kvm_vcpu *vcpu, u64 val) { unsigned long vitv = VCPU(vcpu, itv); VCPU(vcpu, itm) = val; if (val > vcpu_get_itc(vcpu)) { VMX(vcpu, itc_check) = 1; vcpu_unpend_interrupt(vcpu, vitv); VMX(vcpu, timer_pending) = 0; } else VMX(vcpu, itc_check) = 0; } #define ITV_VECTOR(itv) (itv&0xff) #define ITV_IRQ_MASK(itv) (itv&(1<<16)) static inline void vcpu_set_itv(struct kvm_vcpu *vcpu, u64 val) { VCPU(vcpu, itv) = val; if (!ITV_IRQ_MASK(val) && vcpu->arch.timer_pending) { vcpu_pend_interrupt(vcpu, ITV_VECTOR(val)); vcpu->arch.timer_pending = 0; } } static inline void vcpu_set_eoi(struct kvm_vcpu *vcpu, u64 val) { int vec; vec = highest_inservice_irq(vcpu); if (vec == NULL_VECTOR) return; VMX(vcpu, insvc[vec >> 6]) &= ~(1UL << (vec & 63)); VCPU(vcpu, eoi) = 0; vcpu->arch.irq_new_pending = 1; } /* See Table 5-8 in SDM vol2 for the definition */ int irq_masked(struct kvm_vcpu *vcpu, int h_pending, int h_inservice) { union ia64_tpr vtpr; vtpr.val = VCPU(vcpu, tpr); if (h_inservice == NMI_VECTOR) return IRQ_MASKED_BY_INSVC; if (h_pending == NMI_VECTOR) { /* Non Maskable Interrupt */ return IRQ_NO_MASKED; } if (h_inservice == ExtINT_VECTOR) return IRQ_MASKED_BY_INSVC; if (h_pending == ExtINT_VECTOR) { if (vtpr.mmi) { /* mask all external IRQ */ return IRQ_MASKED_BY_VTPR; } else return IRQ_NO_MASKED; } if (is_higher_irq(h_pending, h_inservice)) { if (is_higher_class(h_pending, vtpr.mic + (vtpr.mmi << 4))) return IRQ_NO_MASKED; else return IRQ_MASKED_BY_VTPR; } else { return IRQ_MASKED_BY_INSVC; } } void vcpu_pend_interrupt(struct kvm_vcpu *vcpu, u8 vec) { long spsr; int ret; local_irq_save(spsr); ret = test_and_set_bit(vec, &VCPU(vcpu, irr[0])); local_irq_restore(spsr); vcpu->arch.irq_new_pending = 1; } void vcpu_unpend_interrupt(struct kvm_vcpu *vcpu, u8 vec) { long spsr; int ret; local_irq_save(spsr); ret = test_and_clear_bit(vec, &VCPU(vcpu, irr[0])); local_irq_restore(spsr); if (ret) { vcpu->arch.irq_new_pending = 1; wmb(); } } void update_vhpi(struct kvm_vcpu *vcpu, int vec) { u64 vhpi; if (vec == NULL_VECTOR) vhpi = 0; else if (vec == NMI_VECTOR) vhpi = 32; else if (vec == ExtINT_VECTOR) vhpi = 16; else vhpi = vec >> 4; VCPU(vcpu, vhpi) = vhpi; if (VCPU(vcpu, vac).a_int) ia64_call_vsa(PAL_VPS_SET_PENDING_INTERRUPT, (u64)vcpu->arch.vpd, 0, 0, 0, 0, 0, 0); } u64 vcpu_get_ivr(struct kvm_vcpu *vcpu) { int vec, h_inservice, mask; vec = highest_pending_irq(vcpu); h_inservice = highest_inservice_irq(vcpu); mask = irq_masked(vcpu, vec, h_inservice); if (vec == NULL_VECTOR || mask == IRQ_MASKED_BY_INSVC) { if (VCPU(vcpu, vhpi)) update_vhpi(vcpu, NULL_VECTOR); return IA64_SPURIOUS_INT_VECTOR; } if (mask == IRQ_MASKED_BY_VTPR) { update_vhpi(vcpu, vec); return IA64_SPURIOUS_INT_VECTOR; } VMX(vcpu, insvc[vec >> 6]) |= (1UL << (vec & 63)); vcpu_unpend_interrupt(vcpu, vec); return (u64)vec; } /************************************************************************** Privileged operation emulation routines **************************************************************************/ u64 vcpu_thash(struct kvm_vcpu *vcpu, u64 vadr) { union ia64_pta vpta; union ia64_rr vrr; u64 pval; u64 vhpt_offset; vpta.val = vcpu_get_pta(vcpu); vrr.val = vcpu_get_rr(vcpu, vadr); vhpt_offset = ((vadr >> vrr.ps) << 3) & ((1UL << (vpta.size)) - 1); if (vpta.vf) { pval = ia64_call_vsa(PAL_VPS_THASH, vadr, vrr.val, vpta.val, 0, 0, 0, 0); } else { pval = (vadr & VRN_MASK) | vhpt_offset | (vpta.val << 3 >> (vpta.size + 3) << (vpta.size)); } return pval; } u64 vcpu_ttag(struct kvm_vcpu *vcpu, u64 vadr) { union ia64_rr vrr; union ia64_pta vpta; u64 pval; vpta.val = vcpu_get_pta(vcpu); vrr.val = vcpu_get_rr(vcpu, vadr); if (vpta.vf) { pval = ia64_call_vsa(PAL_VPS_TTAG, vadr, vrr.val, 0, 0, 0, 0, 0); } else pval = 1; return pval; } u64 vcpu_tak(struct kvm_vcpu *vcpu, u64 vadr) { struct thash_data *data; union ia64_pta vpta; u64 key; vpta.val = vcpu_get_pta(vcpu); if (vpta.vf == 0) { key = 1; return key; } data = vtlb_lookup(vcpu, vadr, D_TLB); if (!data || !data->p) key = 1; else key = data->key; return key; } void kvm_thash(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long thash, vadr; vadr = vcpu_get_gr(vcpu, inst.M46.r3); thash = vcpu_thash(vcpu, vadr); vcpu_set_gr(vcpu, inst.M46.r1, thash, 0); } void kvm_ttag(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long tag, vadr; vadr = vcpu_get_gr(vcpu, inst.M46.r3); tag = vcpu_ttag(vcpu, vadr); vcpu_set_gr(vcpu, inst.M46.r1, tag, 0); } int vcpu_tpa(struct kvm_vcpu *vcpu, u64 vadr, unsigned long *padr) { struct thash_data *data; union ia64_isr visr, pt_isr; struct kvm_pt_regs *regs; struct ia64_psr vpsr; regs = vcpu_regs(vcpu); pt_isr.val = VMX(vcpu, cr_isr); visr.val = 0; visr.ei = pt_isr.ei; visr.ir = pt_isr.ir; vpsr = *(struct ia64_psr *)&VCPU(vcpu, vpsr); visr.na = 1; data = vhpt_lookup(vadr); if (data) { if (data->p == 0) { vcpu_set_isr(vcpu, visr.val); data_page_not_present(vcpu, vadr); return IA64_FAULT; } else if (data->ma == VA_MATTR_NATPAGE) { vcpu_set_isr(vcpu, visr.val); dnat_page_consumption(vcpu, vadr); return IA64_FAULT; } else { *padr = (data->gpaddr >> data->ps << data->ps) | (vadr & (PSIZE(data->ps) - 1)); return IA64_NO_FAULT; } } data = vtlb_lookup(vcpu, vadr, D_TLB); if (data) { if (data->p == 0) { vcpu_set_isr(vcpu, visr.val); data_page_not_present(vcpu, vadr); return IA64_FAULT; } else if (data->ma == VA_MATTR_NATPAGE) { vcpu_set_isr(vcpu, visr.val); dnat_page_consumption(vcpu, vadr); return IA64_FAULT; } else{ *padr = ((data->ppn >> (data->ps - 12)) << data->ps) | (vadr & (PSIZE(data->ps) - 1)); return IA64_NO_FAULT; } } if (!vhpt_enabled(vcpu, vadr, NA_REF)) { if (vpsr.ic) { vcpu_set_isr(vcpu, visr.val); alt_dtlb(vcpu, vadr); return IA64_FAULT; } else { nested_dtlb(vcpu); return IA64_FAULT; } } else { if (vpsr.ic) { vcpu_set_isr(vcpu, visr.val); dvhpt_fault(vcpu, vadr); return IA64_FAULT; } else{ nested_dtlb(vcpu); return IA64_FAULT; } } return IA64_NO_FAULT; } int kvm_tpa(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r1, r3; r3 = vcpu_get_gr(vcpu, inst.M46.r3); if (vcpu_tpa(vcpu, r3, &r1)) return IA64_FAULT; vcpu_set_gr(vcpu, inst.M46.r1, r1, 0); return(IA64_NO_FAULT); } void kvm_tak(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r1, r3; r3 = vcpu_get_gr(vcpu, inst.M46.r3); r1 = vcpu_tak(vcpu, r3); vcpu_set_gr(vcpu, inst.M46.r1, r1, 0); } /************************************ * Insert/Purge translation register/cache ************************************/ void vcpu_itc_i(struct kvm_vcpu *vcpu, u64 pte, u64 itir, u64 ifa) { thash_purge_and_insert(vcpu, pte, itir, ifa, I_TLB); } void vcpu_itc_d(struct kvm_vcpu *vcpu, u64 pte, u64 itir, u64 ifa) { thash_purge_and_insert(vcpu, pte, itir, ifa, D_TLB); } void vcpu_itr_i(struct kvm_vcpu *vcpu, u64 slot, u64 pte, u64 itir, u64 ifa) { u64 ps, va, rid; struct thash_data *p_itr; ps = itir_ps(itir); va = PAGEALIGN(ifa, ps); pte &= ~PAGE_FLAGS_RV_MASK; rid = vcpu_get_rr(vcpu, ifa); rid = rid & RR_RID_MASK; p_itr = (struct thash_data *)&vcpu->arch.itrs[slot]; vcpu_set_tr(p_itr, pte, itir, va, rid); vcpu_quick_region_set(VMX(vcpu, itr_regions), va); } void vcpu_itr_d(struct kvm_vcpu *vcpu, u64 slot, u64 pte, u64 itir, u64 ifa) { u64 gpfn; u64 ps, va, rid; struct thash_data *p_dtr; ps = itir_ps(itir); va = PAGEALIGN(ifa, ps); pte &= ~PAGE_FLAGS_RV_MASK; if (ps != _PAGE_SIZE_16M) thash_purge_entries(vcpu, va, ps); gpfn = (pte & _PAGE_PPN_MASK) >> PAGE_SHIFT; if (__gpfn_is_io(gpfn)) pte |= VTLB_PTE_IO; rid = vcpu_get_rr(vcpu, va); rid = rid & RR_RID_MASK; p_dtr = (struct thash_data *)&vcpu->arch.dtrs[slot]; vcpu_set_tr((struct thash_data *)&vcpu->arch.dtrs[slot], pte, itir, va, rid); vcpu_quick_region_set(VMX(vcpu, dtr_regions), va); } void vcpu_ptr_d(struct kvm_vcpu *vcpu, u64 ifa, u64 ps) { int index; u64 va; va = PAGEALIGN(ifa, ps); while ((index = vtr_find_overlap(vcpu, va, ps, D_TLB)) >= 0) vcpu->arch.dtrs[index].page_flags = 0; thash_purge_entries(vcpu, va, ps); } void vcpu_ptr_i(struct kvm_vcpu *vcpu, u64 ifa, u64 ps) { int index; u64 va; va = PAGEALIGN(ifa, ps); while ((index = vtr_find_overlap(vcpu, va, ps, I_TLB)) >= 0) vcpu->arch.itrs[index].page_flags = 0; thash_purge_entries(vcpu, va, ps); } void vcpu_ptc_l(struct kvm_vcpu *vcpu, u64 va, u64 ps) { va = PAGEALIGN(va, ps); thash_purge_entries(vcpu, va, ps); } void vcpu_ptc_e(struct kvm_vcpu *vcpu, u64 va) { thash_purge_all(vcpu); } void vcpu_ptc_ga(struct kvm_vcpu *vcpu, u64 va, u64 ps) { struct exit_ctl_data *p = &vcpu->arch.exit_data; long psr; local_irq_save(psr); p->exit_reason = EXIT_REASON_PTC_G; p->u.ptc_g_data.rr = vcpu_get_rr(vcpu, va); p->u.ptc_g_data.vaddr = va; p->u.ptc_g_data.ps = ps; vmm_transition(vcpu); /* Do Local Purge Here*/ vcpu_ptc_l(vcpu, va, ps); local_irq_restore(psr); } void vcpu_ptc_g(struct kvm_vcpu *vcpu, u64 va, u64 ps) { vcpu_ptc_ga(vcpu, va, ps); } void kvm_ptc_e(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa; ifa = vcpu_get_gr(vcpu, inst.M45.r3); vcpu_ptc_e(vcpu, ifa); } void kvm_ptc_g(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa, itir; ifa = vcpu_get_gr(vcpu, inst.M45.r3); itir = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_ptc_g(vcpu, ifa, itir_ps(itir)); } void kvm_ptc_ga(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa, itir; ifa = vcpu_get_gr(vcpu, inst.M45.r3); itir = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_ptc_ga(vcpu, ifa, itir_ps(itir)); } void kvm_ptc_l(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa, itir; ifa = vcpu_get_gr(vcpu, inst.M45.r3); itir = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_ptc_l(vcpu, ifa, itir_ps(itir)); } void kvm_ptr_d(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa, itir; ifa = vcpu_get_gr(vcpu, inst.M45.r3); itir = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_ptr_d(vcpu, ifa, itir_ps(itir)); } void kvm_ptr_i(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long ifa, itir; ifa = vcpu_get_gr(vcpu, inst.M45.r3); itir = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_ptr_i(vcpu, ifa, itir_ps(itir)); } void kvm_itr_d(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long itir, ifa, pte, slot; slot = vcpu_get_gr(vcpu, inst.M45.r3); pte = vcpu_get_gr(vcpu, inst.M45.r2); itir = vcpu_get_itir(vcpu); ifa = vcpu_get_ifa(vcpu); vcpu_itr_d(vcpu, slot, pte, itir, ifa); } void kvm_itr_i(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long itir, ifa, pte, slot; slot = vcpu_get_gr(vcpu, inst.M45.r3); pte = vcpu_get_gr(vcpu, inst.M45.r2); itir = vcpu_get_itir(vcpu); ifa = vcpu_get_ifa(vcpu); vcpu_itr_i(vcpu, slot, pte, itir, ifa); } void kvm_itc_d(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long itir, ifa, pte; itir = vcpu_get_itir(vcpu); ifa = vcpu_get_ifa(vcpu); pte = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_itc_d(vcpu, pte, itir, ifa); } void kvm_itc_i(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long itir, ifa, pte; itir = vcpu_get_itir(vcpu); ifa = vcpu_get_ifa(vcpu); pte = vcpu_get_gr(vcpu, inst.M45.r2); vcpu_itc_i(vcpu, pte, itir, ifa); } /************************************* * Moves to semi-privileged registers *************************************/ void kvm_mov_to_ar_imm(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long imm; if (inst.M30.s) imm = -inst.M30.imm; else imm = inst.M30.imm; vcpu_set_itc(vcpu, imm); } void kvm_mov_to_ar_reg(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r2; r2 = vcpu_get_gr(vcpu, inst.M29.r2); vcpu_set_itc(vcpu, r2); } void kvm_mov_from_ar_reg(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r1; r1 = vcpu_get_itc(vcpu); vcpu_set_gr(vcpu, inst.M31.r1, r1, 0); } /************************************************************************** struct kvm_vcpu protection key register access routines **************************************************************************/ unsigned long vcpu_get_pkr(struct kvm_vcpu *vcpu, unsigned long reg) { return ((unsigned long)ia64_get_pkr(reg)); } void vcpu_set_pkr(struct kvm_vcpu *vcpu, unsigned long reg, unsigned long val) { ia64_set_pkr(reg, val); } /******************************** * Moves to privileged registers ********************************/ unsigned long vcpu_set_rr(struct kvm_vcpu *vcpu, unsigned long reg, unsigned long val) { union ia64_rr oldrr, newrr; unsigned long rrval; struct exit_ctl_data *p = &vcpu->arch.exit_data; unsigned long psr; oldrr.val = vcpu_get_rr(vcpu, reg); newrr.val = val; vcpu->arch.vrr[reg >> VRN_SHIFT] = val; switch ((unsigned long)(reg >> VRN_SHIFT)) { case VRN6: vcpu->arch.vmm_rr = vrrtomrr(val); local_irq_save(psr); p->exit_reason = EXIT_REASON_SWITCH_RR6; vmm_transition(vcpu); local_irq_restore(psr); break; case VRN4: rrval = vrrtomrr(val); vcpu->arch.metaphysical_saved_rr4 = rrval; if (!is_physical_mode(vcpu)) ia64_set_rr(reg, rrval); break; case VRN0: rrval = vrrtomrr(val); vcpu->arch.metaphysical_saved_rr0 = rrval; if (!is_physical_mode(vcpu)) ia64_set_rr(reg, rrval); break; default: ia64_set_rr(reg, vrrtomrr(val)); break; } return (IA64_NO_FAULT); } void kvm_mov_to_rr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r2; r3 = vcpu_get_gr(vcpu, inst.M42.r3); r2 = vcpu_get_gr(vcpu, inst.M42.r2); vcpu_set_rr(vcpu, r3, r2); } void kvm_mov_to_dbr(struct kvm_vcpu *vcpu, INST64 inst) { } void kvm_mov_to_ibr(struct kvm_vcpu *vcpu, INST64 inst) { } void kvm_mov_to_pmc(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r2; r3 = vcpu_get_gr(vcpu, inst.M42.r3); r2 = vcpu_get_gr(vcpu, inst.M42.r2); vcpu_set_pmc(vcpu, r3, r2); } void kvm_mov_to_pmd(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r2; r3 = vcpu_get_gr(vcpu, inst.M42.r3); r2 = vcpu_get_gr(vcpu, inst.M42.r2); vcpu_set_pmd(vcpu, r3, r2); } void kvm_mov_to_pkr(struct kvm_vcpu *vcpu, INST64 inst) { u64 r3, r2; r3 = vcpu_get_gr(vcpu, inst.M42.r3); r2 = vcpu_get_gr(vcpu, inst.M42.r2); vcpu_set_pkr(vcpu, r3, r2); } void kvm_mov_from_rr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_rr(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } void kvm_mov_from_pkr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_pkr(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } void kvm_mov_from_dbr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_dbr(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } void kvm_mov_from_ibr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_ibr(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } void kvm_mov_from_pmc(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_pmc(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } unsigned long vcpu_get_cpuid(struct kvm_vcpu *vcpu, unsigned long reg) { /* FIXME: This could get called as a result of a rsvd-reg fault */ if (reg > (ia64_get_cpuid(3) & 0xff)) return 0; else return ia64_get_cpuid(reg); } void kvm_mov_from_cpuid(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r3, r1; r3 = vcpu_get_gr(vcpu, inst.M43.r3); r1 = vcpu_get_cpuid(vcpu, r3); vcpu_set_gr(vcpu, inst.M43.r1, r1, 0); } void vcpu_set_tpr(struct kvm_vcpu *vcpu, unsigned long val) { VCPU(vcpu, tpr) = val; vcpu->arch.irq_check = 1; } unsigned long kvm_mov_to_cr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long r2; r2 = vcpu_get_gr(vcpu, inst.M32.r2); VCPU(vcpu, vcr[inst.M32.cr3]) = r2; switch (inst.M32.cr3) { case 0: vcpu_set_dcr(vcpu, r2); break; case 1: vcpu_set_itm(vcpu, r2); break; case 66: vcpu_set_tpr(vcpu, r2); break; case 67: vcpu_set_eoi(vcpu, r2); break; default: break; } return 0; } unsigned long kvm_mov_from_cr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long tgt = inst.M33.r1; unsigned long val; switch (inst.M33.cr3) { case 65: val = vcpu_get_ivr(vcpu); vcpu_set_gr(vcpu, tgt, val, 0); break; case 67: vcpu_set_gr(vcpu, tgt, 0L, 0); break; default: val = VCPU(vcpu, vcr[inst.M33.cr3]); vcpu_set_gr(vcpu, tgt, val, 0); break; } return 0; } void vcpu_set_psr(struct kvm_vcpu *vcpu, unsigned long val) { unsigned long mask; struct kvm_pt_regs *regs; struct ia64_psr old_psr, new_psr; old_psr = *(struct ia64_psr *)&VCPU(vcpu, vpsr); regs = vcpu_regs(vcpu); /* We only support guest as: * vpsr.pk = 0 * vpsr.is = 0 * Otherwise panic */ if (val & (IA64_PSR_PK | IA64_PSR_IS | IA64_PSR_VM)) panic_vm(vcpu, "Only support guests with vpsr.pk =0 " "& vpsr.is=0\n"); /* * For those IA64_PSR bits: id/da/dd/ss/ed/ia * Since these bits will become 0, after success execution of each * instruction, we will change set them to mIA64_PSR */ VCPU(vcpu, vpsr) = val & (~(IA64_PSR_ID | IA64_PSR_DA | IA64_PSR_DD | IA64_PSR_SS | IA64_PSR_ED | IA64_PSR_IA)); if (!old_psr.i && (val & IA64_PSR_I)) { /* vpsr.i 0->1 */ vcpu->arch.irq_check = 1; } new_psr = *(struct ia64_psr *)&VCPU(vcpu, vpsr); /* * All vIA64_PSR bits shall go to mPSR (v->tf->tf_special.psr) * , except for the following bits: * ic/i/dt/si/rt/mc/it/bn/vm */ mask = IA64_PSR_IC + IA64_PSR_I + IA64_PSR_DT + IA64_PSR_SI + IA64_PSR_RT + IA64_PSR_MC + IA64_PSR_IT + IA64_PSR_BN + IA64_PSR_VM; regs->cr_ipsr = (regs->cr_ipsr & mask) | (val & (~mask)); check_mm_mode_switch(vcpu, old_psr, new_psr); return ; } unsigned long vcpu_cover(struct kvm_vcpu *vcpu) { struct ia64_psr vpsr; struct kvm_pt_regs *regs = vcpu_regs(vcpu); vpsr = *(struct ia64_psr *)&VCPU(vcpu, vpsr); if (!vpsr.ic) VCPU(vcpu, ifs) = regs->cr_ifs; regs->cr_ifs = IA64_IFS_V; return (IA64_NO_FAULT); } /************************************************************************** VCPU banked general register access routines **************************************************************************/ #define vcpu_bsw0_unat(i, b0unat, b1unat, runat, VMM_PT_REGS_R16_SLOT) \ do { \ __asm__ __volatile__ ( \ ";;extr.u %0 = %3,%6,16;;\n" \ "dep %1 = %0, %1, 0, 16;;\n" \ "st8 [%4] = %1\n" \ "extr.u %0 = %2, 16, 16;;\n" \ "dep %3 = %0, %3, %6, 16;;\n" \ "st8 [%5] = %3\n" \ ::"r"(i), "r"(*b1unat), "r"(*b0unat), \ "r"(*runat), "r"(b1unat), "r"(runat), \ "i"(VMM_PT_REGS_R16_SLOT) : "memory"); \ } while (0) void vcpu_bsw0(struct kvm_vcpu *vcpu) { unsigned long i; struct kvm_pt_regs *regs = vcpu_regs(vcpu); unsigned long *r = ®s->r16; unsigned long *b0 = &VCPU(vcpu, vbgr[0]); unsigned long *b1 = &VCPU(vcpu, vgr[0]); unsigned long *runat = ®s->eml_unat; unsigned long *b0unat = &VCPU(vcpu, vbnat); unsigned long *b1unat = &VCPU(vcpu, vnat); if (VCPU(vcpu, vpsr) & IA64_PSR_BN) { for (i = 0; i < 16; i++) { *b1++ = *r; *r++ = *b0++; } vcpu_bsw0_unat(i, b0unat, b1unat, runat, VMM_PT_REGS_R16_SLOT); VCPU(vcpu, vpsr) &= ~IA64_PSR_BN; } } #define vcpu_bsw1_unat(i, b0unat, b1unat, runat, VMM_PT_REGS_R16_SLOT) \ do { \ __asm__ __volatile__ (";;extr.u %0 = %3, %6, 16;;\n" \ "dep %1 = %0, %1, 16, 16;;\n" \ "st8 [%4] = %1\n" \ "extr.u %0 = %2, 0, 16;;\n" \ "dep %3 = %0, %3, %6, 16;;\n" \ "st8 [%5] = %3\n" \ ::"r"(i), "r"(*b0unat), "r"(*b1unat), \ "r"(*runat), "r"(b0unat), "r"(runat), \ "i"(VMM_PT_REGS_R16_SLOT) : "memory"); \ } while (0) void vcpu_bsw1(struct kvm_vcpu *vcpu) { unsigned long i; struct kvm_pt_regs *regs = vcpu_regs(vcpu); unsigned long *r = ®s->r16; unsigned long *b0 = &VCPU(vcpu, vbgr[0]); unsigned long *b1 = &VCPU(vcpu, vgr[0]); unsigned long *runat = ®s->eml_unat; unsigned long *b0unat = &VCPU(vcpu, vbnat); unsigned long *b1unat = &VCPU(vcpu, vnat); if (!(VCPU(vcpu, vpsr) & IA64_PSR_BN)) { for (i = 0; i < 16; i++) { *b0++ = *r; *r++ = *b1++; } vcpu_bsw1_unat(i, b0unat, b1unat, runat, VMM_PT_REGS_R16_SLOT); VCPU(vcpu, vpsr) |= IA64_PSR_BN; } } void vcpu_rfi(struct kvm_vcpu *vcpu) { unsigned long ifs, psr; struct kvm_pt_regs *regs = vcpu_regs(vcpu); psr = VCPU(vcpu, ipsr); if (psr & IA64_PSR_BN) vcpu_bsw1(vcpu); else vcpu_bsw0(vcpu); vcpu_set_psr(vcpu, psr); ifs = VCPU(vcpu, ifs); if (ifs >> 63) regs->cr_ifs = ifs; regs->cr_iip = VCPU(vcpu, iip); } /* VPSR can't keep track of below bits of guest PSR This function gets guest PSR */ unsigned long vcpu_get_psr(struct kvm_vcpu *vcpu) { unsigned long mask; struct kvm_pt_regs *regs = vcpu_regs(vcpu); mask = IA64_PSR_BE | IA64_PSR_UP | IA64_PSR_AC | IA64_PSR_MFL | IA64_PSR_MFH | IA64_PSR_CPL | IA64_PSR_RI; return (VCPU(vcpu, vpsr) & ~mask) | (regs->cr_ipsr & mask); } void kvm_rsm(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long vpsr; unsigned long imm24 = (inst.M44.i<<23) | (inst.M44.i2<<21) | inst.M44.imm; vpsr = vcpu_get_psr(vcpu); vpsr &= (~imm24); vcpu_set_psr(vcpu, vpsr); } void kvm_ssm(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long vpsr; unsigned long imm24 = (inst.M44.i << 23) | (inst.M44.i2 << 21) | inst.M44.imm; vpsr = vcpu_get_psr(vcpu); vpsr |= imm24; vcpu_set_psr(vcpu, vpsr); } /* Generate Mask * Parameter: * bit -- starting bit * len -- how many bits */ #define MASK(bit,len) \ ({ \ __u64 ret; \ \ __asm __volatile("dep %0=-1, r0, %1, %2"\ : "=r" (ret): \ "M" (bit), \ "M" (len)); \ ret; \ }) void vcpu_set_psr_l(struct kvm_vcpu *vcpu, unsigned long val) { val = (val & MASK(0, 32)) | (vcpu_get_psr(vcpu) & MASK(32, 32)); vcpu_set_psr(vcpu, val); } void kvm_mov_to_psr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long val; val = vcpu_get_gr(vcpu, inst.M35.r2); vcpu_set_psr_l(vcpu, val); } void kvm_mov_from_psr(struct kvm_vcpu *vcpu, INST64 inst) { unsigned long val; val = vcpu_get_psr(vcpu); val = (val & MASK(0, 32)) | (val & MASK(35, 2)); vcpu_set_gr(vcpu, inst.M33.r1, val, 0); } void vcpu_increment_iip(struct kvm_vcpu *vcpu) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); struct ia64_psr *ipsr = (struct ia64_psr *)®s->cr_ipsr; if (ipsr->ri == 2) { ipsr->ri = 0; regs->cr_iip += 16; } else ipsr->ri++; } void vcpu_decrement_iip(struct kvm_vcpu *vcpu) { struct kvm_pt_regs *regs = vcpu_regs(vcpu); struct ia64_psr *ipsr = (struct ia64_psr *)®s->cr_ipsr; if (ipsr->ri == 0) { ipsr->ri = 2; regs->cr_iip -= 16; } else ipsr->ri--; } /** Emulate a privileged operation. * * * @param vcpu virtual cpu * @cause the reason cause virtualization fault * @opcode the instruction code which cause virtualization fault */ void kvm_emulate(struct kvm_vcpu *vcpu, struct kvm_pt_regs *regs) { unsigned long status, cause, opcode ; INST64 inst; status = IA64_NO_FAULT; cause = VMX(vcpu, cause); opcode = VMX(vcpu, opcode); inst.inst = opcode; /* * Switch to actual virtual rid in rr0 and rr4, * which is required by some tlb related instructions. */ prepare_if_physical_mode(vcpu); switch (cause) { case EVENT_RSM: kvm_rsm(vcpu, inst); break; case EVENT_SSM: kvm_ssm(vcpu, inst); break; case EVENT_MOV_TO_PSR: kvm_mov_to_psr(vcpu, inst); break; case EVENT_MOV_FROM_PSR: kvm_mov_from_psr(vcpu, inst); break; case EVENT_MOV_FROM_CR: kvm_mov_from_cr(vcpu, inst); break; case EVENT_MOV_TO_CR: kvm_mov_to_cr(vcpu, inst); break; case EVENT_BSW_0: vcpu_bsw0(vcpu); break; case EVENT_BSW_1: vcpu_bsw1(vcpu); break; case EVENT_COVER: vcpu_cover(vcpu); break; case EVENT_RFI: vcpu_rfi(vcpu); break; case EVENT_ITR_D: kvm_itr_d(vcpu, inst); break; case EVENT_ITR_I: kvm_itr_i(vcpu, inst); break; case EVENT_PTR_D: kvm_ptr_d(vcpu, inst); break; case EVENT_PTR_I: kvm_ptr_i(vcpu, inst); break; case EVENT_ITC_D: kvm_itc_d(vcpu, inst); break; case EVENT_ITC_I: kvm_itc_i(vcpu, inst); break; case EVENT_PTC_L: kvm_ptc_l(vcpu, inst); break; case EVENT_PTC_G: kvm_ptc_g(vcpu, inst); break; case EVENT_PTC_GA: kvm_ptc_ga(vcpu, inst); break; case EVENT_PTC_E: kvm_ptc_e(vcpu, inst); break; case EVENT_MOV_TO_RR: kvm_mov_to_rr(vcpu, inst); break; case EVENT_MOV_FROM_RR: kvm_mov_from_rr(vcpu, inst); break; case EVENT_THASH: kvm_thash(vcpu, inst); break; case EVENT_TTAG: kvm_ttag(vcpu, inst); break; case EVENT_TPA: status = kvm_tpa(vcpu, inst); break; case EVENT_TAK: kvm_tak(vcpu, inst); break; case EVENT_MOV_TO_AR_IMM: kvm_mov_to_ar_imm(vcpu, inst); break; case EVENT_MOV_TO_AR: kvm_mov_to_ar_reg(vcpu, inst); break; case EVENT_MOV_FROM_AR: kvm_mov_from_ar_reg(vcpu, inst); break; case EVENT_MOV_TO_DBR: kvm_mov_to_dbr(vcpu, inst); break; case EVENT_MOV_TO_IBR: kvm_mov_to_ibr(vcpu, inst); break; case EVENT_MOV_TO_PMC: kvm_mov_to_pmc(vcpu, inst); break; case EVENT_MOV_TO_PMD: kvm_mov_to_pmd(vcpu, inst); break; case EVENT_MOV_TO_PKR: kvm_mov_to_pkr(vcpu, inst); break; case EVENT_MOV_FROM_DBR: kvm_mov_from_dbr(vcpu, inst); break; case EVENT_MOV_FROM_IBR: kvm_mov_from_ibr(vcpu, inst); break; case EVENT_MOV_FROM_PMC: kvm_mov_from_pmc(vcpu, inst); break; case EVENT_MOV_FROM_PKR: kvm_mov_from_pkr(vcpu, inst); break; case EVENT_MOV_FROM_CPUID: kvm_mov_from_cpuid(vcpu, inst); break; case EVENT_VMSW: status = IA64_FAULT; break; default: break; }; /*Assume all status is NO_FAULT ?*/ if (status == IA64_NO_FAULT && cause != EVENT_RFI) vcpu_increment_iip(vcpu); recover_if_physical_mode(vcpu); } void init_vcpu(struct kvm_vcpu *vcpu) { int i; vcpu->arch.mode_flags = GUEST_IN_PHY; VMX(vcpu, vrr[0]) = 0x38; VMX(vcpu, vrr[1]) = 0x38; VMX(vcpu, vrr[2]) = 0x38; VMX(vcpu, vrr[3]) = 0x38; VMX(vcpu, vrr[4]) = 0x38; VMX(vcpu, vrr[5]) = 0x38; VMX(vcpu, vrr[6]) = 0x38; VMX(vcpu, vrr[7]) = 0x38; VCPU(vcpu, vpsr) = IA64_PSR_BN; VCPU(vcpu, dcr) = 0; /* pta.size must not be 0. The minimum is 15 (32k) */ VCPU(vcpu, pta) = 15 << 2; VCPU(vcpu, itv) = 0x10000; VCPU(vcpu, itm) = 0; VMX(vcpu, last_itc) = 0; VCPU(vcpu, lid) = VCPU_LID(vcpu); VCPU(vcpu, ivr) = 0; VCPU(vcpu, tpr) = 0x10000; VCPU(vcpu, eoi) = 0; VCPU(vcpu, irr[0]) = 0; VCPU(vcpu, irr[1]) = 0; VCPU(vcpu, irr[2]) = 0; VCPU(vcpu, irr[3]) = 0; VCPU(vcpu, pmv) = 0x10000; VCPU(vcpu, cmcv) = 0x10000; VCPU(vcpu, lrr0) = 0x10000; /* default reset value? */ VCPU(vcpu, lrr1) = 0x10000; /* default reset value? */ update_vhpi(vcpu, NULL_VECTOR); VLSAPIC_XTP(vcpu) = 0x80; /* disabled */ for (i = 0; i < 4; i++) VLSAPIC_INSVC(vcpu, i) = 0; } void kvm_init_all_rr(struct kvm_vcpu *vcpu) { unsigned long psr; local_irq_save(psr); /* WARNING: not allow co-exist of both virtual mode and physical * mode in same region */ vcpu->arch.metaphysical_saved_rr0 = vrrtomrr(VMX(vcpu, vrr[VRN0])); vcpu->arch.metaphysical_saved_rr4 = vrrtomrr(VMX(vcpu, vrr[VRN4])); if (is_physical_mode(vcpu)) { if (vcpu->arch.mode_flags & GUEST_PHY_EMUL) panic_vm(vcpu, "Machine Status conflicts!\n"); ia64_set_rr((VRN0 << VRN_SHIFT), vcpu->arch.metaphysical_rr0); ia64_dv_serialize_data(); ia64_set_rr((VRN4 << VRN_SHIFT), vcpu->arch.metaphysical_rr4); ia64_dv_serialize_data(); } else { ia64_set_rr((VRN0 << VRN_SHIFT), vcpu->arch.metaphysical_saved_rr0); ia64_dv_serialize_data(); ia64_set_rr((VRN4 << VRN_SHIFT), vcpu->arch.metaphysical_saved_rr4); ia64_dv_serialize_data(); } ia64_set_rr((VRN1 << VRN_SHIFT), vrrtomrr(VMX(vcpu, vrr[VRN1]))); ia64_dv_serialize_data(); ia64_set_rr((VRN2 << VRN_SHIFT), vrrtomrr(VMX(vcpu, vrr[VRN2]))); ia64_dv_serialize_data(); ia64_set_rr((VRN3 << VRN_SHIFT), vrrtomrr(VMX(vcpu, vrr[VRN3]))); ia64_dv_serialize_data(); ia64_set_rr((VRN5 << VRN_SHIFT), vrrtomrr(VMX(vcpu, vrr[VRN5]))); ia64_dv_serialize_data(); ia64_set_rr((VRN7 << VRN_SHIFT), vrrtomrr(VMX(vcpu, vrr[VRN7]))); ia64_dv_serialize_data(); ia64_srlz_d(); ia64_set_psr(psr); } int vmm_entry(void) { struct kvm_vcpu *v; v = current_vcpu; ia64_call_vsa(PAL_VPS_RESTORE, (unsigned long)v->arch.vpd, 0, 0, 0, 0, 0, 0); kvm_init_vtlb(v); kvm_init_vhpt(v); init_vcpu(v); kvm_init_all_rr(v); vmm_reset_entry(); return 0; } static void kvm_show_registers(struct kvm_pt_regs *regs) { unsigned long ip = regs->cr_iip + ia64_psr(regs)->ri; struct kvm_vcpu *vcpu = current_vcpu; if (vcpu != NULL) printk("vcpu 0x%p vcpu %d\n", vcpu, vcpu->vcpu_id); printk("psr : %016lx ifs : %016lx ip : [<%016lx>]\n", regs->cr_ipsr, regs->cr_ifs, ip); printk("unat: %016lx pfs : %016lx rsc : %016lx\n", regs->ar_unat, regs->ar_pfs, regs->ar_rsc); printk("rnat: %016lx bspstore: %016lx pr : %016lx\n", regs->ar_rnat, regs->ar_bspstore, regs->pr); printk("ldrs: %016lx ccv : %016lx fpsr: %016lx\n", regs->loadrs, regs->ar_ccv, regs->ar_fpsr); printk("csd : %016lx ssd : %016lx\n", regs->ar_csd, regs->ar_ssd); printk("b0 : %016lx b6 : %016lx b7 : %016lx\n", regs->b0, regs->b6, regs->b7); printk("f6 : %05lx%016lx f7 : %05lx%016lx\n", regs->f6.u.bits[1], regs->f6.u.bits[0], regs->f7.u.bits[1], regs->f7.u.bits[0]); printk("f8 : %05lx%016lx f9 : %05lx%016lx\n", regs->f8.u.bits[1], regs->f8.u.bits[0], regs->f9.u.bits[1], regs->f9.u.bits[0]); printk("f10 : %05lx%016lx f11 : %05lx%016lx\n", regs->f10.u.bits[1], regs->f10.u.bits[0], regs->f11.u.bits[1], regs->f11.u.bits[0]); printk("r1 : %016lx r2 : %016lx r3 : %016lx\n", regs->r1, regs->r2, regs->r3); printk("r8 : %016lx r9 : %016lx r10 : %016lx\n", regs->r8, regs->r9, regs->r10); printk("r11 : %016lx r12 : %016lx r13 : %016lx\n", regs->r11, regs->r12, regs->r13); printk("r14 : %016lx r15 : %016lx r16 : %016lx\n", regs->r14, regs->r15, regs->r16); printk("r17 : %016lx r18 : %016lx r19 : %016lx\n", regs->r17, regs->r18, regs->r19); printk("r20 : %016lx r21 : %016lx r22 : %016lx\n", regs->r20, regs->r21, regs->r22); printk("r23 : %016lx r24 : %016lx r25 : %016lx\n", regs->r23, regs->r24, regs->r25); printk("r26 : %016lx r27 : %016lx r28 : %016lx\n", regs->r26, regs->r27, regs->r28); printk("r29 : %016lx r30 : %016lx r31 : %016lx\n", regs->r29, regs->r30, regs->r31); } void panic_vm(struct kvm_vcpu *v, const char *fmt, ...) { va_list args; char buf[256]; struct kvm_pt_regs *regs = vcpu_regs(v); struct exit_ctl_data *p = &v->arch.exit_data; va_start(args, fmt); vsnprintf(buf, sizeof(buf), fmt, args); va_end(args); printk(buf); kvm_show_registers(regs); p->exit_reason = EXIT_REASON_VM_PANIC; vmm_transition(v); /*Never to return*/ while (1); }