| /* |
| * arch/ia64/kvm/optvfault.S |
| * optimize virtualization fault handler |
| * |
| * Copyright (C) 2006 Intel Co |
| * Xuefei Xu (Anthony Xu) <anthony.xu@intel.com> |
| * Copyright (C) 2008 Intel Co |
| * Add the support for Tukwila processors. |
| * Xiantao Zhang <xiantao.zhang@intel.com> |
| */ |
| |
| #include <asm/asmmacro.h> |
| #include <asm/processor.h> |
| |
| #include "vti.h" |
| #include "asm-offsets.h" |
| |
| #define ACCE_MOV_FROM_AR |
| #define ACCE_MOV_FROM_RR |
| #define ACCE_MOV_TO_RR |
| #define ACCE_RSM |
| #define ACCE_SSM |
| #define ACCE_MOV_TO_PSR |
| #define ACCE_THASH |
| |
| #define VMX_VPS_SYNC_READ \ |
| add r16=VMM_VPD_BASE_OFFSET,r21; \ |
| mov r17 = b0; \ |
| mov r18 = r24; \ |
| mov r19 = r25; \ |
| mov r20 = r31; \ |
| ;; \ |
| {.mii; \ |
| ld8 r16 = [r16]; \ |
| nop 0x0; \ |
| mov r24 = ip; \ |
| ;; \ |
| }; \ |
| {.mmb; \ |
| add r24=0x20, r24; \ |
| mov r25 =r16; \ |
| br.sptk.many kvm_vps_sync_read; \ |
| }; \ |
| mov b0 = r17; \ |
| mov r24 = r18; \ |
| mov r25 = r19; \ |
| mov r31 = r20 |
| |
| ENTRY(kvm_vps_entry) |
| adds r29 = VMM_VCPU_VSA_BASE_OFFSET,r21 |
| ;; |
| ld8 r29 = [r29] |
| ;; |
| add r29 = r29, r30 |
| ;; |
| mov b0 = r29 |
| br.sptk.many b0 |
| END(kvm_vps_entry) |
| |
| /* |
| * Inputs: |
| * r24 : return address |
| * r25 : vpd |
| * r29 : scratch |
| * |
| */ |
| GLOBAL_ENTRY(kvm_vps_sync_read) |
| movl r30 = PAL_VPS_SYNC_READ |
| ;; |
| br.sptk.many kvm_vps_entry |
| END(kvm_vps_sync_read) |
| |
| /* |
| * Inputs: |
| * r24 : return address |
| * r25 : vpd |
| * r29 : scratch |
| * |
| */ |
| GLOBAL_ENTRY(kvm_vps_sync_write) |
| movl r30 = PAL_VPS_SYNC_WRITE |
| ;; |
| br.sptk.many kvm_vps_entry |
| END(kvm_vps_sync_write) |
| |
| /* |
| * Inputs: |
| * r23 : pr |
| * r24 : guest b0 |
| * r25 : vpd |
| * |
| */ |
| GLOBAL_ENTRY(kvm_vps_resume_normal) |
| movl r30 = PAL_VPS_RESUME_NORMAL |
| ;; |
| mov pr=r23,-2 |
| br.sptk.many kvm_vps_entry |
| END(kvm_vps_resume_normal) |
| |
| /* |
| * Inputs: |
| * r23 : pr |
| * r24 : guest b0 |
| * r25 : vpd |
| * r17 : isr |
| */ |
| GLOBAL_ENTRY(kvm_vps_resume_handler) |
| movl r30 = PAL_VPS_RESUME_HANDLER |
| ;; |
| ld8 r27=[r25] |
| shr r17=r17,IA64_ISR_IR_BIT |
| ;; |
| dep r27=r17,r27,63,1 // bit 63 of r27 indicate whether enable CFLE |
| mov pr=r23,-2 |
| br.sptk.many kvm_vps_entry |
| END(kvm_vps_resume_handler) |
| |
| //mov r1=ar3 |
| GLOBAL_ENTRY(kvm_asm_mov_from_ar) |
| #ifndef ACCE_MOV_FROM_AR |
| br.many kvm_virtualization_fault_back |
| #endif |
| add r18=VMM_VCPU_ITC_OFS_OFFSET, r21 |
| add r16=VMM_VCPU_LAST_ITC_OFFSET,r21 |
| extr.u r17=r25,6,7 |
| ;; |
| ld8 r18=[r18] |
| mov r19=ar.itc |
| mov r24=b0 |
| ;; |
| add r19=r19,r18 |
| addl r20=@gprel(asm_mov_to_reg),gp |
| ;; |
| st8 [r16] = r19 |
| adds r30=kvm_resume_to_guest-asm_mov_to_reg,r20 |
| shladd r17=r17,4,r20 |
| ;; |
| mov b0=r17 |
| br.sptk.few b0 |
| ;; |
| END(kvm_asm_mov_from_ar) |
| |
| |
| // mov r1=rr[r3] |
| GLOBAL_ENTRY(kvm_asm_mov_from_rr) |
| #ifndef ACCE_MOV_FROM_RR |
| br.many kvm_virtualization_fault_back |
| #endif |
| extr.u r16=r25,20,7 |
| extr.u r17=r25,6,7 |
| addl r20=@gprel(asm_mov_from_reg),gp |
| ;; |
| adds r30=kvm_asm_mov_from_rr_back_1-asm_mov_from_reg,r20 |
| shladd r16=r16,4,r20 |
| mov r24=b0 |
| ;; |
| add r27=VMM_VCPU_VRR0_OFFSET,r21 |
| mov b0=r16 |
| br.many b0 |
| ;; |
| kvm_asm_mov_from_rr_back_1: |
| adds r30=kvm_resume_to_guest-asm_mov_from_reg,r20 |
| adds r22=asm_mov_to_reg-asm_mov_from_reg,r20 |
| shr.u r26=r19,61 |
| ;; |
| shladd r17=r17,4,r22 |
| shladd r27=r26,3,r27 |
| ;; |
| ld8 r19=[r27] |
| mov b0=r17 |
| br.many b0 |
| END(kvm_asm_mov_from_rr) |
| |
| |
| // mov rr[r3]=r2 |
| GLOBAL_ENTRY(kvm_asm_mov_to_rr) |
| #ifndef ACCE_MOV_TO_RR |
| br.many kvm_virtualization_fault_back |
| #endif |
| extr.u r16=r25,20,7 |
| extr.u r17=r25,13,7 |
| addl r20=@gprel(asm_mov_from_reg),gp |
| ;; |
| adds r30=kvm_asm_mov_to_rr_back_1-asm_mov_from_reg,r20 |
| shladd r16=r16,4,r20 |
| mov r22=b0 |
| ;; |
| add r27=VMM_VCPU_VRR0_OFFSET,r21 |
| mov b0=r16 |
| br.many b0 |
| ;; |
| kvm_asm_mov_to_rr_back_1: |
| adds r30=kvm_asm_mov_to_rr_back_2-asm_mov_from_reg,r20 |
| shr.u r23=r19,61 |
| shladd r17=r17,4,r20 |
| ;; |
| //if rr6, go back |
| cmp.eq p6,p0=6,r23 |
| mov b0=r22 |
| (p6) br.cond.dpnt.many kvm_virtualization_fault_back |
| ;; |
| mov r28=r19 |
| mov b0=r17 |
| br.many b0 |
| kvm_asm_mov_to_rr_back_2: |
| adds r30=kvm_resume_to_guest-asm_mov_from_reg,r20 |
| shladd r27=r23,3,r27 |
| ;; // vrr.rid<<4 |0xe |
| st8 [r27]=r19 |
| mov b0=r30 |
| ;; |
| extr.u r16=r19,8,26 |
| extr.u r18 =r19,2,6 |
| mov r17 =0xe |
| ;; |
| shladd r16 = r16, 4, r17 |
| extr.u r19 =r19,0,8 |
| ;; |
| shl r16 = r16,8 |
| ;; |
| add r19 = r19, r16 |
| ;; //set ve 1 |
| dep r19=-1,r19,0,1 |
| cmp.lt p6,p0=14,r18 |
| ;; |
| (p6) mov r18=14 |
| ;; |
| (p6) dep r19=r18,r19,2,6 |
| ;; |
| cmp.eq p6,p0=0,r23 |
| ;; |
| cmp.eq.or p6,p0=4,r23 |
| ;; |
| adds r16=VMM_VCPU_MODE_FLAGS_OFFSET,r21 |
| (p6) adds r17=VMM_VCPU_META_SAVED_RR0_OFFSET,r21 |
| ;; |
| ld4 r16=[r16] |
| cmp.eq p7,p0=r0,r0 |
| (p6) shladd r17=r23,1,r17 |
| ;; |
| (p6) st8 [r17]=r19 |
| (p6) tbit.nz p6,p7=r16,0 |
| ;; |
| (p7) mov rr[r28]=r19 |
| mov r24=r22 |
| br.many b0 |
| END(kvm_asm_mov_to_rr) |
| |
| |
| //rsm |
| GLOBAL_ENTRY(kvm_asm_rsm) |
| #ifndef ACCE_RSM |
| br.many kvm_virtualization_fault_back |
| #endif |
| VMX_VPS_SYNC_READ |
| ;; |
| extr.u r26=r25,6,21 |
| extr.u r27=r25,31,2 |
| ;; |
| extr.u r28=r25,36,1 |
| dep r26=r27,r26,21,2 |
| ;; |
| add r17=VPD_VPSR_START_OFFSET,r16 |
| add r22=VMM_VCPU_MODE_FLAGS_OFFSET,r21 |
| //r26 is imm24 |
| dep r26=r28,r26,23,1 |
| ;; |
| ld8 r18=[r17] |
| movl r28=IA64_PSR_IC+IA64_PSR_I+IA64_PSR_DT+IA64_PSR_SI |
| ld4 r23=[r22] |
| sub r27=-1,r26 |
| mov r24=b0 |
| ;; |
| mov r20=cr.ipsr |
| or r28=r27,r28 |
| and r19=r18,r27 |
| ;; |
| st8 [r17]=r19 |
| and r20=r20,r28 |
| /* Comment it out due to short of fp lazy alorgithm support |
| adds r27=IA64_VCPU_FP_PSR_OFFSET,r21 |
| ;; |
| ld8 r27=[r27] |
| ;; |
| tbit.nz p8,p0= r27,IA64_PSR_DFH_BIT |
| ;; |
| (p8) dep r20=-1,r20,IA64_PSR_DFH_BIT,1 |
| */ |
| ;; |
| mov cr.ipsr=r20 |
| tbit.nz p6,p0=r23,0 |
| ;; |
| tbit.z.or p6,p0=r26,IA64_PSR_DT_BIT |
| (p6) br.dptk kvm_resume_to_guest_with_sync |
| ;; |
| add r26=VMM_VCPU_META_RR0_OFFSET,r21 |
| add r27=VMM_VCPU_META_RR0_OFFSET+8,r21 |
| dep r23=-1,r23,0,1 |
| ;; |
| ld8 r26=[r26] |
| ld8 r27=[r27] |
| st4 [r22]=r23 |
| dep.z r28=4,61,3 |
| ;; |
| mov rr[r0]=r26 |
| ;; |
| mov rr[r28]=r27 |
| ;; |
| srlz.d |
| br.many kvm_resume_to_guest_with_sync |
| END(kvm_asm_rsm) |
| |
| |
| //ssm |
| GLOBAL_ENTRY(kvm_asm_ssm) |
| #ifndef ACCE_SSM |
| br.many kvm_virtualization_fault_back |
| #endif |
| VMX_VPS_SYNC_READ |
| ;; |
| extr.u r26=r25,6,21 |
| extr.u r27=r25,31,2 |
| ;; |
| extr.u r28=r25,36,1 |
| dep r26=r27,r26,21,2 |
| ;; //r26 is imm24 |
| add r27=VPD_VPSR_START_OFFSET,r16 |
| dep r26=r28,r26,23,1 |
| ;; //r19 vpsr |
| ld8 r29=[r27] |
| mov r24=b0 |
| ;; |
| add r22=VMM_VCPU_MODE_FLAGS_OFFSET,r21 |
| mov r20=cr.ipsr |
| or r19=r29,r26 |
| ;; |
| ld4 r23=[r22] |
| st8 [r27]=r19 |
| or r20=r20,r26 |
| ;; |
| mov cr.ipsr=r20 |
| movl r28=IA64_PSR_DT+IA64_PSR_RT+IA64_PSR_IT |
| ;; |
| and r19=r28,r19 |
| tbit.z p6,p0=r23,0 |
| ;; |
| cmp.ne.or p6,p0=r28,r19 |
| (p6) br.dptk kvm_asm_ssm_1 |
| ;; |
| add r26=VMM_VCPU_META_SAVED_RR0_OFFSET,r21 |
| add r27=VMM_VCPU_META_SAVED_RR0_OFFSET+8,r21 |
| dep r23=0,r23,0,1 |
| ;; |
| ld8 r26=[r26] |
| ld8 r27=[r27] |
| st4 [r22]=r23 |
| dep.z r28=4,61,3 |
| ;; |
| mov rr[r0]=r26 |
| ;; |
| mov rr[r28]=r27 |
| ;; |
| srlz.d |
| ;; |
| kvm_asm_ssm_1: |
| tbit.nz p6,p0=r29,IA64_PSR_I_BIT |
| ;; |
| tbit.z.or p6,p0=r19,IA64_PSR_I_BIT |
| (p6) br.dptk kvm_resume_to_guest_with_sync |
| ;; |
| add r29=VPD_VTPR_START_OFFSET,r16 |
| add r30=VPD_VHPI_START_OFFSET,r16 |
| ;; |
| ld8 r29=[r29] |
| ld8 r30=[r30] |
| ;; |
| extr.u r17=r29,4,4 |
| extr.u r18=r29,16,1 |
| ;; |
| dep r17=r18,r17,4,1 |
| ;; |
| cmp.gt p6,p0=r30,r17 |
| (p6) br.dpnt.few kvm_asm_dispatch_vexirq |
| br.many kvm_resume_to_guest_with_sync |
| END(kvm_asm_ssm) |
| |
| |
| //mov psr.l=r2 |
| GLOBAL_ENTRY(kvm_asm_mov_to_psr) |
| #ifndef ACCE_MOV_TO_PSR |
| br.many kvm_virtualization_fault_back |
| #endif |
| VMX_VPS_SYNC_READ |
| ;; |
| extr.u r26=r25,13,7 //r2 |
| addl r20=@gprel(asm_mov_from_reg),gp |
| ;; |
| adds r30=kvm_asm_mov_to_psr_back-asm_mov_from_reg,r20 |
| shladd r26=r26,4,r20 |
| mov r24=b0 |
| ;; |
| add r27=VPD_VPSR_START_OFFSET,r16 |
| mov b0=r26 |
| br.many b0 |
| ;; |
| kvm_asm_mov_to_psr_back: |
| ld8 r17=[r27] |
| add r22=VMM_VCPU_MODE_FLAGS_OFFSET,r21 |
| dep r19=0,r19,32,32 |
| ;; |
| ld4 r23=[r22] |
| dep r18=0,r17,0,32 |
| ;; |
| add r30=r18,r19 |
| movl r28=IA64_PSR_DT+IA64_PSR_RT+IA64_PSR_IT |
| ;; |
| st8 [r27]=r30 |
| and r27=r28,r30 |
| and r29=r28,r17 |
| ;; |
| cmp.eq p5,p0=r29,r27 |
| cmp.eq p6,p7=r28,r27 |
| (p5) br.many kvm_asm_mov_to_psr_1 |
| ;; |
| //virtual to physical |
| (p7) add r26=VMM_VCPU_META_RR0_OFFSET,r21 |
| (p7) add r27=VMM_VCPU_META_RR0_OFFSET+8,r21 |
| (p7) dep r23=-1,r23,0,1 |
| ;; |
| //physical to virtual |
| (p6) add r26=VMM_VCPU_META_SAVED_RR0_OFFSET,r21 |
| (p6) add r27=VMM_VCPU_META_SAVED_RR0_OFFSET+8,r21 |
| (p6) dep r23=0,r23,0,1 |
| ;; |
| ld8 r26=[r26] |
| ld8 r27=[r27] |
| st4 [r22]=r23 |
| dep.z r28=4,61,3 |
| ;; |
| mov rr[r0]=r26 |
| ;; |
| mov rr[r28]=r27 |
| ;; |
| srlz.d |
| ;; |
| kvm_asm_mov_to_psr_1: |
| mov r20=cr.ipsr |
| movl r28=IA64_PSR_IC+IA64_PSR_I+IA64_PSR_DT+IA64_PSR_SI+IA64_PSR_RT |
| ;; |
| or r19=r19,r28 |
| dep r20=0,r20,0,32 |
| ;; |
| add r20=r19,r20 |
| mov b0=r24 |
| ;; |
| /* Comment it out due to short of fp lazy algorithm support |
| adds r27=IA64_VCPU_FP_PSR_OFFSET,r21 |
| ;; |
| ld8 r27=[r27] |
| ;; |
| tbit.nz p8,p0=r27,IA64_PSR_DFH_BIT |
| ;; |
| (p8) dep r20=-1,r20,IA64_PSR_DFH_BIT,1 |
| ;; |
| */ |
| mov cr.ipsr=r20 |
| cmp.ne p6,p0=r0,r0 |
| ;; |
| tbit.nz.or p6,p0=r17,IA64_PSR_I_BIT |
| tbit.z.or p6,p0=r30,IA64_PSR_I_BIT |
| (p6) br.dpnt.few kvm_resume_to_guest_with_sync |
| ;; |
| add r29=VPD_VTPR_START_OFFSET,r16 |
| add r30=VPD_VHPI_START_OFFSET,r16 |
| ;; |
| ld8 r29=[r29] |
| ld8 r30=[r30] |
| ;; |
| extr.u r17=r29,4,4 |
| extr.u r18=r29,16,1 |
| ;; |
| dep r17=r18,r17,4,1 |
| ;; |
| cmp.gt p6,p0=r30,r17 |
| (p6) br.dpnt.few kvm_asm_dispatch_vexirq |
| br.many kvm_resume_to_guest_with_sync |
| END(kvm_asm_mov_to_psr) |
| |
| |
| ENTRY(kvm_asm_dispatch_vexirq) |
| //increment iip |
| mov r17 = b0 |
| mov r18 = r31 |
| {.mii |
| add r25=VMM_VPD_BASE_OFFSET,r21 |
| nop 0x0 |
| mov r24 = ip |
| ;; |
| } |
| {.mmb |
| add r24 = 0x20, r24 |
| ld8 r25 = [r25] |
| br.sptk.many kvm_vps_sync_write |
| } |
| mov b0 =r17 |
| mov r16=cr.ipsr |
| mov r31 = r18 |
| mov r19 = 37 |
| ;; |
| extr.u r17=r16,IA64_PSR_RI_BIT,2 |
| tbit.nz p6,p7=r16,IA64_PSR_RI_BIT+1 |
| ;; |
| (p6) mov r18=cr.iip |
| (p6) mov r17=r0 |
| (p7) add r17=1,r17 |
| ;; |
| (p6) add r18=0x10,r18 |
| dep r16=r17,r16,IA64_PSR_RI_BIT,2 |
| ;; |
| (p6) mov cr.iip=r18 |
| mov cr.ipsr=r16 |
| mov r30 =1 |
| br.many kvm_dispatch_vexirq |
| END(kvm_asm_dispatch_vexirq) |
| |
| // thash |
| // TODO: add support when pta.vf = 1 |
| GLOBAL_ENTRY(kvm_asm_thash) |
| #ifndef ACCE_THASH |
| br.many kvm_virtualization_fault_back |
| #endif |
| extr.u r17=r25,20,7 // get r3 from opcode in r25 |
| extr.u r18=r25,6,7 // get r1 from opcode in r25 |
| addl r20=@gprel(asm_mov_from_reg),gp |
| ;; |
| adds r30=kvm_asm_thash_back1-asm_mov_from_reg,r20 |
| shladd r17=r17,4,r20 // get addr of MOVE_FROM_REG(r17) |
| adds r16=VMM_VPD_BASE_OFFSET,r21 // get vcpu.arch.priveregs |
| ;; |
| mov r24=b0 |
| ;; |
| ld8 r16=[r16] // get VPD addr |
| mov b0=r17 |
| br.many b0 // r19 return value |
| ;; |
| kvm_asm_thash_back1: |
| shr.u r23=r19,61 // get RR number |
| adds r28=VMM_VCPU_VRR0_OFFSET,r21 // get vcpu->arch.vrr[0]'s addr |
| adds r16=VMM_VPD_VPTA_OFFSET,r16 // get vpta |
| ;; |
| shladd r27=r23,3,r28 // get vcpu->arch.vrr[r23]'s addr |
| ld8 r17=[r16] // get PTA |
| mov r26=1 |
| ;; |
| extr.u r29=r17,2,6 // get pta.size |
| ld8 r28=[r27] // get vcpu->arch.vrr[r23]'s value |
| ;; |
| mov b0=r24 |
| //Fallback to C if pta.vf is set |
| tbit.nz p6,p0=r17, 8 |
| ;; |
| (p6) mov r24=EVENT_THASH |
| (p6) br.cond.dpnt.many kvm_virtualization_fault_back |
| extr.u r28=r28,2,6 // get rr.ps |
| shl r22=r26,r29 // 1UL << pta.size |
| ;; |
| shr.u r23=r19,r28 // vaddr >> rr.ps |
| adds r26=3,r29 // pta.size + 3 |
| shl r27=r17,3 // pta << 3 |
| ;; |
| shl r23=r23,3 // (vaddr >> rr.ps) << 3 |
| shr.u r27=r27,r26 // (pta << 3) >> (pta.size+3) |
| movl r16=7<<61 |
| ;; |
| adds r22=-1,r22 // (1UL << pta.size) - 1 |
| shl r27=r27,r29 // ((pta<<3)>>(pta.size+3))<<pta.size |
| and r19=r19,r16 // vaddr & VRN_MASK |
| ;; |
| and r22=r22,r23 // vhpt_offset |
| or r19=r19,r27 // (vadr&VRN_MASK)|(((pta<<3)>>(pta.size + 3))<<pta.size) |
| adds r26=asm_mov_to_reg-asm_mov_from_reg,r20 |
| ;; |
| or r19=r19,r22 // calc pval |
| shladd r17=r18,4,r26 |
| adds r30=kvm_resume_to_guest-asm_mov_from_reg,r20 |
| ;; |
| mov b0=r17 |
| br.many b0 |
| END(kvm_asm_thash) |
| |
| #define MOV_TO_REG0 \ |
| {; \ |
| nop.b 0x0; \ |
| nop.b 0x0; \ |
| nop.b 0x0; \ |
| ;; \ |
| }; |
| |
| |
| #define MOV_TO_REG(n) \ |
| {; \ |
| mov r##n##=r19; \ |
| mov b0=r30; \ |
| br.sptk.many b0; \ |
| ;; \ |
| }; |
| |
| |
| #define MOV_FROM_REG(n) \ |
| {; \ |
| mov r19=r##n##; \ |
| mov b0=r30; \ |
| br.sptk.many b0; \ |
| ;; \ |
| }; |
| |
| |
| #define MOV_TO_BANK0_REG(n) \ |
| ENTRY_MIN_ALIGN(asm_mov_to_bank0_reg##n##); \ |
| {; \ |
| mov r26=r2; \ |
| mov r2=r19; \ |
| bsw.1; \ |
| ;; \ |
| }; \ |
| {; \ |
| mov r##n##=r2; \ |
| nop.b 0x0; \ |
| bsw.0; \ |
| ;; \ |
| }; \ |
| {; \ |
| mov r2=r26; \ |
| mov b0=r30; \ |
| br.sptk.many b0; \ |
| ;; \ |
| }; \ |
| END(asm_mov_to_bank0_reg##n##) |
| |
| |
| #define MOV_FROM_BANK0_REG(n) \ |
| ENTRY_MIN_ALIGN(asm_mov_from_bank0_reg##n##); \ |
| {; \ |
| mov r26=r2; \ |
| nop.b 0x0; \ |
| bsw.1; \ |
| ;; \ |
| }; \ |
| {; \ |
| mov r2=r##n##; \ |
| nop.b 0x0; \ |
| bsw.0; \ |
| ;; \ |
| }; \ |
| {; \ |
| mov r19=r2; \ |
| mov r2=r26; \ |
| mov b0=r30; \ |
| }; \ |
| {; \ |
| nop.b 0x0; \ |
| nop.b 0x0; \ |
| br.sptk.many b0; \ |
| ;; \ |
| }; \ |
| END(asm_mov_from_bank0_reg##n##) |
| |
| |
| #define JMP_TO_MOV_TO_BANK0_REG(n) \ |
| {; \ |
| nop.b 0x0; \ |
| nop.b 0x0; \ |
| br.sptk.many asm_mov_to_bank0_reg##n##; \ |
| ;; \ |
| } |
| |
| |
| #define JMP_TO_MOV_FROM_BANK0_REG(n) \ |
| {; \ |
| nop.b 0x0; \ |
| nop.b 0x0; \ |
| br.sptk.many asm_mov_from_bank0_reg##n##; \ |
| ;; \ |
| } |
| |
| |
| MOV_FROM_BANK0_REG(16) |
| MOV_FROM_BANK0_REG(17) |
| MOV_FROM_BANK0_REG(18) |
| MOV_FROM_BANK0_REG(19) |
| MOV_FROM_BANK0_REG(20) |
| MOV_FROM_BANK0_REG(21) |
| MOV_FROM_BANK0_REG(22) |
| MOV_FROM_BANK0_REG(23) |
| MOV_FROM_BANK0_REG(24) |
| MOV_FROM_BANK0_REG(25) |
| MOV_FROM_BANK0_REG(26) |
| MOV_FROM_BANK0_REG(27) |
| MOV_FROM_BANK0_REG(28) |
| MOV_FROM_BANK0_REG(29) |
| MOV_FROM_BANK0_REG(30) |
| MOV_FROM_BANK0_REG(31) |
| |
| |
| // mov from reg table |
| ENTRY(asm_mov_from_reg) |
| MOV_FROM_REG(0) |
| MOV_FROM_REG(1) |
| MOV_FROM_REG(2) |
| MOV_FROM_REG(3) |
| MOV_FROM_REG(4) |
| MOV_FROM_REG(5) |
| MOV_FROM_REG(6) |
| MOV_FROM_REG(7) |
| MOV_FROM_REG(8) |
| MOV_FROM_REG(9) |
| MOV_FROM_REG(10) |
| MOV_FROM_REG(11) |
| MOV_FROM_REG(12) |
| MOV_FROM_REG(13) |
| MOV_FROM_REG(14) |
| MOV_FROM_REG(15) |
| JMP_TO_MOV_FROM_BANK0_REG(16) |
| JMP_TO_MOV_FROM_BANK0_REG(17) |
| JMP_TO_MOV_FROM_BANK0_REG(18) |
| JMP_TO_MOV_FROM_BANK0_REG(19) |
| JMP_TO_MOV_FROM_BANK0_REG(20) |
| JMP_TO_MOV_FROM_BANK0_REG(21) |
| JMP_TO_MOV_FROM_BANK0_REG(22) |
| JMP_TO_MOV_FROM_BANK0_REG(23) |
| JMP_TO_MOV_FROM_BANK0_REG(24) |
| JMP_TO_MOV_FROM_BANK0_REG(25) |
| JMP_TO_MOV_FROM_BANK0_REG(26) |
| JMP_TO_MOV_FROM_BANK0_REG(27) |
| JMP_TO_MOV_FROM_BANK0_REG(28) |
| JMP_TO_MOV_FROM_BANK0_REG(29) |
| JMP_TO_MOV_FROM_BANK0_REG(30) |
| JMP_TO_MOV_FROM_BANK0_REG(31) |
| MOV_FROM_REG(32) |
| MOV_FROM_REG(33) |
| MOV_FROM_REG(34) |
| MOV_FROM_REG(35) |
| MOV_FROM_REG(36) |
| MOV_FROM_REG(37) |
| MOV_FROM_REG(38) |
| MOV_FROM_REG(39) |
| MOV_FROM_REG(40) |
| MOV_FROM_REG(41) |
| MOV_FROM_REG(42) |
| MOV_FROM_REG(43) |
| MOV_FROM_REG(44) |
| MOV_FROM_REG(45) |
| MOV_FROM_REG(46) |
| MOV_FROM_REG(47) |
| MOV_FROM_REG(48) |
| MOV_FROM_REG(49) |
| MOV_FROM_REG(50) |
| MOV_FROM_REG(51) |
| MOV_FROM_REG(52) |
| MOV_FROM_REG(53) |
| MOV_FROM_REG(54) |
| MOV_FROM_REG(55) |
| MOV_FROM_REG(56) |
| MOV_FROM_REG(57) |
| MOV_FROM_REG(58) |
| MOV_FROM_REG(59) |
| MOV_FROM_REG(60) |
| MOV_FROM_REG(61) |
| MOV_FROM_REG(62) |
| MOV_FROM_REG(63) |
| MOV_FROM_REG(64) |
| MOV_FROM_REG(65) |
| MOV_FROM_REG(66) |
| MOV_FROM_REG(67) |
| MOV_FROM_REG(68) |
| MOV_FROM_REG(69) |
| MOV_FROM_REG(70) |
| MOV_FROM_REG(71) |
| MOV_FROM_REG(72) |
| MOV_FROM_REG(73) |
| MOV_FROM_REG(74) |
| MOV_FROM_REG(75) |
| MOV_FROM_REG(76) |
| MOV_FROM_REG(77) |
| MOV_FROM_REG(78) |
| MOV_FROM_REG(79) |
| MOV_FROM_REG(80) |
| MOV_FROM_REG(81) |
| MOV_FROM_REG(82) |
| MOV_FROM_REG(83) |
| MOV_FROM_REG(84) |
| MOV_FROM_REG(85) |
| MOV_FROM_REG(86) |
| MOV_FROM_REG(87) |
| MOV_FROM_REG(88) |
| MOV_FROM_REG(89) |
| MOV_FROM_REG(90) |
| MOV_FROM_REG(91) |
| MOV_FROM_REG(92) |
| MOV_FROM_REG(93) |
| MOV_FROM_REG(94) |
| MOV_FROM_REG(95) |
| MOV_FROM_REG(96) |
| MOV_FROM_REG(97) |
| MOV_FROM_REG(98) |
| MOV_FROM_REG(99) |
| MOV_FROM_REG(100) |
| MOV_FROM_REG(101) |
| MOV_FROM_REG(102) |
| MOV_FROM_REG(103) |
| MOV_FROM_REG(104) |
| MOV_FROM_REG(105) |
| MOV_FROM_REG(106) |
| MOV_FROM_REG(107) |
| MOV_FROM_REG(108) |
| MOV_FROM_REG(109) |
| MOV_FROM_REG(110) |
| MOV_FROM_REG(111) |
| MOV_FROM_REG(112) |
| MOV_FROM_REG(113) |
| MOV_FROM_REG(114) |
| MOV_FROM_REG(115) |
| MOV_FROM_REG(116) |
| MOV_FROM_REG(117) |
| MOV_FROM_REG(118) |
| MOV_FROM_REG(119) |
| MOV_FROM_REG(120) |
| MOV_FROM_REG(121) |
| MOV_FROM_REG(122) |
| MOV_FROM_REG(123) |
| MOV_FROM_REG(124) |
| MOV_FROM_REG(125) |
| MOV_FROM_REG(126) |
| MOV_FROM_REG(127) |
| END(asm_mov_from_reg) |
| |
| |
| /* must be in bank 0 |
| * parameter: |
| * r31: pr |
| * r24: b0 |
| */ |
| ENTRY(kvm_resume_to_guest_with_sync) |
| adds r19=VMM_VPD_BASE_OFFSET,r21 |
| mov r16 = r31 |
| mov r17 = r24 |
| ;; |
| {.mii |
| ld8 r25 =[r19] |
| nop 0x0 |
| mov r24 = ip |
| ;; |
| } |
| {.mmb |
| add r24 =0x20, r24 |
| nop 0x0 |
| br.sptk.many kvm_vps_sync_write |
| } |
| |
| mov r31 = r16 |
| mov r24 =r17 |
| ;; |
| br.sptk.many kvm_resume_to_guest |
| END(kvm_resume_to_guest_with_sync) |
| |
| ENTRY(kvm_resume_to_guest) |
| adds r16 = VMM_VCPU_SAVED_GP_OFFSET,r21 |
| ;; |
| ld8 r1 =[r16] |
| adds r20 = VMM_VCPU_VSA_BASE_OFFSET,r21 |
| ;; |
| mov r16=cr.ipsr |
| ;; |
| ld8 r20 = [r20] |
| adds r19=VMM_VPD_BASE_OFFSET,r21 |
| ;; |
| ld8 r25=[r19] |
| extr.u r17=r16,IA64_PSR_RI_BIT,2 |
| tbit.nz p6,p7=r16,IA64_PSR_RI_BIT+1 |
| ;; |
| (p6) mov r18=cr.iip |
| (p6) mov r17=r0 |
| ;; |
| (p6) add r18=0x10,r18 |
| (p7) add r17=1,r17 |
| ;; |
| (p6) mov cr.iip=r18 |
| dep r16=r17,r16,IA64_PSR_RI_BIT,2 |
| ;; |
| mov cr.ipsr=r16 |
| adds r19= VPD_VPSR_START_OFFSET,r25 |
| add r28=PAL_VPS_RESUME_NORMAL,r20 |
| add r29=PAL_VPS_RESUME_HANDLER,r20 |
| ;; |
| ld8 r19=[r19] |
| mov b0=r29 |
| cmp.ne p6,p7 = r0,r0 |
| ;; |
| tbit.z p6,p7 = r19,IA64_PSR_IC_BIT // p1=vpsr.ic |
| ;; |
| (p6) ld8 r26=[r25] |
| (p7) mov b0=r28 |
| mov pr=r31,-2 |
| br.sptk.many b0 // call pal service |
| ;; |
| END(kvm_resume_to_guest) |
| |
| |
| MOV_TO_BANK0_REG(16) |
| MOV_TO_BANK0_REG(17) |
| MOV_TO_BANK0_REG(18) |
| MOV_TO_BANK0_REG(19) |
| MOV_TO_BANK0_REG(20) |
| MOV_TO_BANK0_REG(21) |
| MOV_TO_BANK0_REG(22) |
| MOV_TO_BANK0_REG(23) |
| MOV_TO_BANK0_REG(24) |
| MOV_TO_BANK0_REG(25) |
| MOV_TO_BANK0_REG(26) |
| MOV_TO_BANK0_REG(27) |
| MOV_TO_BANK0_REG(28) |
| MOV_TO_BANK0_REG(29) |
| MOV_TO_BANK0_REG(30) |
| MOV_TO_BANK0_REG(31) |
| |
| |
| // mov to reg table |
| ENTRY(asm_mov_to_reg) |
| MOV_TO_REG0 |
| MOV_TO_REG(1) |
| MOV_TO_REG(2) |
| MOV_TO_REG(3) |
| MOV_TO_REG(4) |
| MOV_TO_REG(5) |
| MOV_TO_REG(6) |
| MOV_TO_REG(7) |
| MOV_TO_REG(8) |
| MOV_TO_REG(9) |
| MOV_TO_REG(10) |
| MOV_TO_REG(11) |
| MOV_TO_REG(12) |
| MOV_TO_REG(13) |
| MOV_TO_REG(14) |
| MOV_TO_REG(15) |
| JMP_TO_MOV_TO_BANK0_REG(16) |
| JMP_TO_MOV_TO_BANK0_REG(17) |
| JMP_TO_MOV_TO_BANK0_REG(18) |
| JMP_TO_MOV_TO_BANK0_REG(19) |
| JMP_TO_MOV_TO_BANK0_REG(20) |
| JMP_TO_MOV_TO_BANK0_REG(21) |
| JMP_TO_MOV_TO_BANK0_REG(22) |
| JMP_TO_MOV_TO_BANK0_REG(23) |
| JMP_TO_MOV_TO_BANK0_REG(24) |
| JMP_TO_MOV_TO_BANK0_REG(25) |
| JMP_TO_MOV_TO_BANK0_REG(26) |
| JMP_TO_MOV_TO_BANK0_REG(27) |
| JMP_TO_MOV_TO_BANK0_REG(28) |
| JMP_TO_MOV_TO_BANK0_REG(29) |
| JMP_TO_MOV_TO_BANK0_REG(30) |
| JMP_TO_MOV_TO_BANK0_REG(31) |
| MOV_TO_REG(32) |
| MOV_TO_REG(33) |
| MOV_TO_REG(34) |
| MOV_TO_REG(35) |
| MOV_TO_REG(36) |
| MOV_TO_REG(37) |
| MOV_TO_REG(38) |
| MOV_TO_REG(39) |
| MOV_TO_REG(40) |
| MOV_TO_REG(41) |
| MOV_TO_REG(42) |
| MOV_TO_REG(43) |
| MOV_TO_REG(44) |
| MOV_TO_REG(45) |
| MOV_TO_REG(46) |
| MOV_TO_REG(47) |
| MOV_TO_REG(48) |
| MOV_TO_REG(49) |
| MOV_TO_REG(50) |
| MOV_TO_REG(51) |
| MOV_TO_REG(52) |
| MOV_TO_REG(53) |
| MOV_TO_REG(54) |
| MOV_TO_REG(55) |
| MOV_TO_REG(56) |
| MOV_TO_REG(57) |
| MOV_TO_REG(58) |
| MOV_TO_REG(59) |
| MOV_TO_REG(60) |
| MOV_TO_REG(61) |
| MOV_TO_REG(62) |
| MOV_TO_REG(63) |
| MOV_TO_REG(64) |
| MOV_TO_REG(65) |
| MOV_TO_REG(66) |
| MOV_TO_REG(67) |
| MOV_TO_REG(68) |
| MOV_TO_REG(69) |
| MOV_TO_REG(70) |
| MOV_TO_REG(71) |
| MOV_TO_REG(72) |
| MOV_TO_REG(73) |
| MOV_TO_REG(74) |
| MOV_TO_REG(75) |
| MOV_TO_REG(76) |
| MOV_TO_REG(77) |
| MOV_TO_REG(78) |
| MOV_TO_REG(79) |
| MOV_TO_REG(80) |
| MOV_TO_REG(81) |
| MOV_TO_REG(82) |
| MOV_TO_REG(83) |
| MOV_TO_REG(84) |
| MOV_TO_REG(85) |
| MOV_TO_REG(86) |
| MOV_TO_REG(87) |
| MOV_TO_REG(88) |
| MOV_TO_REG(89) |
| MOV_TO_REG(90) |
| MOV_TO_REG(91) |
| MOV_TO_REG(92) |
| MOV_TO_REG(93) |
| MOV_TO_REG(94) |
| MOV_TO_REG(95) |
| MOV_TO_REG(96) |
| MOV_TO_REG(97) |
| MOV_TO_REG(98) |
| MOV_TO_REG(99) |
| MOV_TO_REG(100) |
| MOV_TO_REG(101) |
| MOV_TO_REG(102) |
| MOV_TO_REG(103) |
| MOV_TO_REG(104) |
| MOV_TO_REG(105) |
| MOV_TO_REG(106) |
| MOV_TO_REG(107) |
| MOV_TO_REG(108) |
| MOV_TO_REG(109) |
| MOV_TO_REG(110) |
| MOV_TO_REG(111) |
| MOV_TO_REG(112) |
| MOV_TO_REG(113) |
| MOV_TO_REG(114) |
| MOV_TO_REG(115) |
| MOV_TO_REG(116) |
| MOV_TO_REG(117) |
| MOV_TO_REG(118) |
| MOV_TO_REG(119) |
| MOV_TO_REG(120) |
| MOV_TO_REG(121) |
| MOV_TO_REG(122) |
| MOV_TO_REG(123) |
| MOV_TO_REG(124) |
| MOV_TO_REG(125) |
| MOV_TO_REG(126) |
| MOV_TO_REG(127) |
| END(asm_mov_to_reg) |