forked from Minki/linux
b595076a18
"gadget", "through", "command", "maintain", "maintain", "controller", "address", "between", "initiali[zs]e", "instead", "function", "select", "already", "equal", "access", "management", "hierarchy", "registration", "interest", "relative", "memory", "offset", "already", Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Signed-off-by: Jiri Kosina <jkosina@suse.cz>
337 lines
8.6 KiB
C
337 lines
8.6 KiB
C
/*
|
|
* mmio.c: MMIO emulation components.
|
|
* Copyright (c) 2004, Intel Corporation.
|
|
* Yaozu Dong (Eddie Dong) (Eddie.dong@intel.com)
|
|
* Kun Tian (Kevin Tian) (Kevin.tian@intel.com)
|
|
*
|
|
* Copyright (c) 2007 Intel Corporation KVM support.
|
|
* Xuefei Xu (Anthony Xu) (anthony.xu@intel.com)
|
|
* Xiantao Zhang (xiantao.zhang@intel.com)
|
|
*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kvm_host.h>
|
|
|
|
#include "vcpu.h"
|
|
|
|
static void vlsapic_write_xtp(struct kvm_vcpu *v, uint8_t val)
|
|
{
|
|
VLSAPIC_XTP(v) = val;
|
|
}
|
|
|
|
/*
|
|
* LSAPIC OFFSET
|
|
*/
|
|
#define PIB_LOW_HALF(ofst) !(ofst & (1 << 20))
|
|
#define PIB_OFST_INTA 0x1E0000
|
|
#define PIB_OFST_XTP 0x1E0008
|
|
|
|
/*
|
|
* execute write IPI op.
|
|
*/
|
|
static void vlsapic_write_ipi(struct kvm_vcpu *vcpu,
|
|
uint64_t addr, uint64_t data)
|
|
{
|
|
struct exit_ctl_data *p = ¤t_vcpu->arch.exit_data;
|
|
unsigned long psr;
|
|
|
|
local_irq_save(psr);
|
|
|
|
p->exit_reason = EXIT_REASON_IPI;
|
|
p->u.ipi_data.addr.val = addr;
|
|
p->u.ipi_data.data.val = data;
|
|
vmm_transition(current_vcpu);
|
|
|
|
local_irq_restore(psr);
|
|
|
|
}
|
|
|
|
void lsapic_write(struct kvm_vcpu *v, unsigned long addr,
|
|
unsigned long length, unsigned long val)
|
|
{
|
|
addr &= (PIB_SIZE - 1);
|
|
|
|
switch (addr) {
|
|
case PIB_OFST_INTA:
|
|
panic_vm(v, "Undefined write on PIB INTA\n");
|
|
break;
|
|
case PIB_OFST_XTP:
|
|
if (length == 1) {
|
|
vlsapic_write_xtp(v, val);
|
|
} else {
|
|
panic_vm(v, "Undefined write on PIB XTP\n");
|
|
}
|
|
break;
|
|
default:
|
|
if (PIB_LOW_HALF(addr)) {
|
|
/*Lower half */
|
|
if (length != 8)
|
|
panic_vm(v, "Can't LHF write with size %ld!\n",
|
|
length);
|
|
else
|
|
vlsapic_write_ipi(v, addr, val);
|
|
} else { /*Upper half */
|
|
panic_vm(v, "IPI-UHF write %lx\n", addr);
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
unsigned long lsapic_read(struct kvm_vcpu *v, unsigned long addr,
|
|
unsigned long length)
|
|
{
|
|
uint64_t result = 0;
|
|
|
|
addr &= (PIB_SIZE - 1);
|
|
|
|
switch (addr) {
|
|
case PIB_OFST_INTA:
|
|
if (length == 1) /* 1 byte load */
|
|
; /* There is no i8259, there is no INTA access*/
|
|
else
|
|
panic_vm(v, "Undefined read on PIB INTA\n");
|
|
|
|
break;
|
|
case PIB_OFST_XTP:
|
|
if (length == 1) {
|
|
result = VLSAPIC_XTP(v);
|
|
} else {
|
|
panic_vm(v, "Undefined read on PIB XTP\n");
|
|
}
|
|
break;
|
|
default:
|
|
panic_vm(v, "Undefined addr access for lsapic!\n");
|
|
break;
|
|
}
|
|
return result;
|
|
}
|
|
|
|
static void mmio_access(struct kvm_vcpu *vcpu, u64 src_pa, u64 *dest,
|
|
u16 s, int ma, int dir)
|
|
{
|
|
unsigned long iot;
|
|
struct exit_ctl_data *p = &vcpu->arch.exit_data;
|
|
unsigned long psr;
|
|
|
|
iot = __gpfn_is_io(src_pa >> PAGE_SHIFT);
|
|
|
|
local_irq_save(psr);
|
|
|
|
/*Intercept the access for PIB range*/
|
|
if (iot == GPFN_PIB) {
|
|
if (!dir)
|
|
lsapic_write(vcpu, src_pa, s, *dest);
|
|
else
|
|
*dest = lsapic_read(vcpu, src_pa, s);
|
|
goto out;
|
|
}
|
|
p->exit_reason = EXIT_REASON_MMIO_INSTRUCTION;
|
|
p->u.ioreq.addr = src_pa;
|
|
p->u.ioreq.size = s;
|
|
p->u.ioreq.dir = dir;
|
|
if (dir == IOREQ_WRITE)
|
|
p->u.ioreq.data = *dest;
|
|
p->u.ioreq.state = STATE_IOREQ_READY;
|
|
vmm_transition(vcpu);
|
|
|
|
if (p->u.ioreq.state == STATE_IORESP_READY) {
|
|
if (dir == IOREQ_READ)
|
|
/* it's necessary to ensure zero extending */
|
|
*dest = p->u.ioreq.data & (~0UL >> (64-(s*8)));
|
|
} else
|
|
panic_vm(vcpu, "Unhandled mmio access returned!\n");
|
|
out:
|
|
local_irq_restore(psr);
|
|
return ;
|
|
}
|
|
|
|
/*
|
|
dir 1: read 0:write
|
|
inst_type 0:integer 1:floating point
|
|
*/
|
|
#define SL_INTEGER 0 /* store/load interger*/
|
|
#define SL_FLOATING 1 /* store/load floating*/
|
|
|
|
void emulate_io_inst(struct kvm_vcpu *vcpu, u64 padr, u64 ma)
|
|
{
|
|
struct kvm_pt_regs *regs;
|
|
IA64_BUNDLE bundle;
|
|
int slot, dir = 0;
|
|
int inst_type = -1;
|
|
u16 size = 0;
|
|
u64 data, slot1a, slot1b, temp, update_reg;
|
|
s32 imm;
|
|
INST64 inst;
|
|
|
|
regs = vcpu_regs(vcpu);
|
|
|
|
if (fetch_code(vcpu, regs->cr_iip, &bundle)) {
|
|
/* if fetch code fail, return and try again */
|
|
return;
|
|
}
|
|
slot = ((struct ia64_psr *)&(regs->cr_ipsr))->ri;
|
|
if (!slot)
|
|
inst.inst = bundle.slot0;
|
|
else if (slot == 1) {
|
|
slot1a = bundle.slot1a;
|
|
slot1b = bundle.slot1b;
|
|
inst.inst = slot1a + (slot1b << 18);
|
|
} else if (slot == 2)
|
|
inst.inst = bundle.slot2;
|
|
|
|
/* Integer Load/Store */
|
|
if (inst.M1.major == 4 && inst.M1.m == 0 && inst.M1.x == 0) {
|
|
inst_type = SL_INTEGER;
|
|
size = (inst.M1.x6 & 0x3);
|
|
if ((inst.M1.x6 >> 2) > 0xb) {
|
|
/*write*/
|
|
dir = IOREQ_WRITE;
|
|
data = vcpu_get_gr(vcpu, inst.M4.r2);
|
|
} else if ((inst.M1.x6 >> 2) < 0xb) {
|
|
/*read*/
|
|
dir = IOREQ_READ;
|
|
}
|
|
} else if (inst.M2.major == 4 && inst.M2.m == 1 && inst.M2.x == 0) {
|
|
/* Integer Load + Reg update */
|
|
inst_type = SL_INTEGER;
|
|
dir = IOREQ_READ;
|
|
size = (inst.M2.x6 & 0x3);
|
|
temp = vcpu_get_gr(vcpu, inst.M2.r3);
|
|
update_reg = vcpu_get_gr(vcpu, inst.M2.r2);
|
|
temp += update_reg;
|
|
vcpu_set_gr(vcpu, inst.M2.r3, temp, 0);
|
|
} else if (inst.M3.major == 5) {
|
|
/*Integer Load/Store + Imm update*/
|
|
inst_type = SL_INTEGER;
|
|
size = (inst.M3.x6&0x3);
|
|
if ((inst.M5.x6 >> 2) > 0xb) {
|
|
/*write*/
|
|
dir = IOREQ_WRITE;
|
|
data = vcpu_get_gr(vcpu, inst.M5.r2);
|
|
temp = vcpu_get_gr(vcpu, inst.M5.r3);
|
|
imm = (inst.M5.s << 31) | (inst.M5.i << 30) |
|
|
(inst.M5.imm7 << 23);
|
|
temp += imm >> 23;
|
|
vcpu_set_gr(vcpu, inst.M5.r3, temp, 0);
|
|
|
|
} else if ((inst.M3.x6 >> 2) < 0xb) {
|
|
/*read*/
|
|
dir = IOREQ_READ;
|
|
temp = vcpu_get_gr(vcpu, inst.M3.r3);
|
|
imm = (inst.M3.s << 31) | (inst.M3.i << 30) |
|
|
(inst.M3.imm7 << 23);
|
|
temp += imm >> 23;
|
|
vcpu_set_gr(vcpu, inst.M3.r3, temp, 0);
|
|
|
|
}
|
|
} else if (inst.M9.major == 6 && inst.M9.x6 == 0x3B
|
|
&& inst.M9.m == 0 && inst.M9.x == 0) {
|
|
/* Floating-point spill*/
|
|
struct ia64_fpreg v;
|
|
|
|
inst_type = SL_FLOATING;
|
|
dir = IOREQ_WRITE;
|
|
vcpu_get_fpreg(vcpu, inst.M9.f2, &v);
|
|
/* Write high word. FIXME: this is a kludge! */
|
|
v.u.bits[1] &= 0x3ffff;
|
|
mmio_access(vcpu, padr + 8, (u64 *)&v.u.bits[1], 8,
|
|
ma, IOREQ_WRITE);
|
|
data = v.u.bits[0];
|
|
size = 3;
|
|
} else if (inst.M10.major == 7 && inst.M10.x6 == 0x3B) {
|
|
/* Floating-point spill + Imm update */
|
|
struct ia64_fpreg v;
|
|
|
|
inst_type = SL_FLOATING;
|
|
dir = IOREQ_WRITE;
|
|
vcpu_get_fpreg(vcpu, inst.M10.f2, &v);
|
|
temp = vcpu_get_gr(vcpu, inst.M10.r3);
|
|
imm = (inst.M10.s << 31) | (inst.M10.i << 30) |
|
|
(inst.M10.imm7 << 23);
|
|
temp += imm >> 23;
|
|
vcpu_set_gr(vcpu, inst.M10.r3, temp, 0);
|
|
|
|
/* Write high word.FIXME: this is a kludge! */
|
|
v.u.bits[1] &= 0x3ffff;
|
|
mmio_access(vcpu, padr + 8, (u64 *)&v.u.bits[1],
|
|
8, ma, IOREQ_WRITE);
|
|
data = v.u.bits[0];
|
|
size = 3;
|
|
} else if (inst.M10.major == 7 && inst.M10.x6 == 0x31) {
|
|
/* Floating-point stf8 + Imm update */
|
|
struct ia64_fpreg v;
|
|
inst_type = SL_FLOATING;
|
|
dir = IOREQ_WRITE;
|
|
size = 3;
|
|
vcpu_get_fpreg(vcpu, inst.M10.f2, &v);
|
|
data = v.u.bits[0]; /* Significand. */
|
|
temp = vcpu_get_gr(vcpu, inst.M10.r3);
|
|
imm = (inst.M10.s << 31) | (inst.M10.i << 30) |
|
|
(inst.M10.imm7 << 23);
|
|
temp += imm >> 23;
|
|
vcpu_set_gr(vcpu, inst.M10.r3, temp, 0);
|
|
} else if (inst.M15.major == 7 && inst.M15.x6 >= 0x2c
|
|
&& inst.M15.x6 <= 0x2f) {
|
|
temp = vcpu_get_gr(vcpu, inst.M15.r3);
|
|
imm = (inst.M15.s << 31) | (inst.M15.i << 30) |
|
|
(inst.M15.imm7 << 23);
|
|
temp += imm >> 23;
|
|
vcpu_set_gr(vcpu, inst.M15.r3, temp, 0);
|
|
|
|
vcpu_increment_iip(vcpu);
|
|
return;
|
|
} else if (inst.M12.major == 6 && inst.M12.m == 1
|
|
&& inst.M12.x == 1 && inst.M12.x6 == 1) {
|
|
/* Floating-point Load Pair + Imm ldfp8 M12*/
|
|
struct ia64_fpreg v;
|
|
|
|
inst_type = SL_FLOATING;
|
|
dir = IOREQ_READ;
|
|
size = 8; /*ldfd*/
|
|
mmio_access(vcpu, padr, &data, size, ma, dir);
|
|
v.u.bits[0] = data;
|
|
v.u.bits[1] = 0x1003E;
|
|
vcpu_set_fpreg(vcpu, inst.M12.f1, &v);
|
|
padr += 8;
|
|
mmio_access(vcpu, padr, &data, size, ma, dir);
|
|
v.u.bits[0] = data;
|
|
v.u.bits[1] = 0x1003E;
|
|
vcpu_set_fpreg(vcpu, inst.M12.f2, &v);
|
|
padr += 8;
|
|
vcpu_set_gr(vcpu, inst.M12.r3, padr, 0);
|
|
vcpu_increment_iip(vcpu);
|
|
return;
|
|
} else {
|
|
inst_type = -1;
|
|
panic_vm(vcpu, "Unsupported MMIO access instruction! "
|
|
"Bunld[0]=0x%lx, Bundle[1]=0x%lx\n",
|
|
bundle.i64[0], bundle.i64[1]);
|
|
}
|
|
|
|
size = 1 << size;
|
|
if (dir == IOREQ_WRITE) {
|
|
mmio_access(vcpu, padr, &data, size, ma, dir);
|
|
} else {
|
|
mmio_access(vcpu, padr, &data, size, ma, dir);
|
|
if (inst_type == SL_INTEGER)
|
|
vcpu_set_gr(vcpu, inst.M1.r1, data, 0);
|
|
else
|
|
panic_vm(vcpu, "Unsupported instruction type!\n");
|
|
|
|
}
|
|
vcpu_increment_iip(vcpu);
|
|
}
|