From patchwork Thu Jun 29 05:50:44 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "lan,Tianyu" X-Patchwork-Id: 9816553 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id B38F4603D7 for ; Thu, 29 Jun 2017 12:00:24 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 10C6F2851A for ; Thu, 29 Jun 2017 12:00:24 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 053BD286E1; Thu, 29 Jun 2017 12:00:24 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-2.7 required=2.0 tests=BAYES_00, DATE_IN_PAST_06_12, RCVD_IN_DNSWL_MED autolearn=ham version=3.3.1 Received: from lists.xenproject.org (lists.xenproject.org [192.237.175.120]) (using TLSv1.2 with cipher AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id 90FAC2851A for ; Thu, 29 Jun 2017 12:00:23 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=lists.xenproject.org) by lists.xenproject.org with esmtp (Exim 4.84_2) (envelope-from ) id 1dQY5N-0006K6-F6; Thu, 29 Jun 2017 11:58:13 +0000 Received: from mail6.bemta6.messagelabs.com ([193.109.254.103]) by lists.xenproject.org with esmtp (Exim 4.84_2) (envelope-from ) id 1dQY5M-0006Cp-Ff for xen-devel@lists.xen.org; Thu, 29 Jun 2017 11:58:12 +0000 Received: from [85.158.143.35] by server-6.bemta-6.messagelabs.com id 1B/92-03937-45BE4595; Thu, 29 Jun 2017 11:58:12 +0000 X-Brightmail-Tracker: H4sIAAAAAAAAA+NgFnrLLMWRWlGSWpSXmKPExsVywNwkVjf4dUi kwcUXRhZLPi5mcWD0OLr7N1MAYxRrZl5SfkUCa8a8tkbWgqmKFceP/GJsYJwm2cXIxSEkMJ1R 4tqZy4xdjJwcEgK8EkeWzWDtYuQAsv0lDj4QgqhpZ5R4+3wFC0gNm4C6xInFE8HqRQSkJa59h uhlFtjHKPHmuSqILSxgJfHoeCc7yBwWAVWJjtN1IGFeAVeJWQcfMUGsUpCY8vA9M4jNCRRvuL mFDcQWEnCR+NSzk3kCI+8CRoZVjBrFqUVlqUW6hsZ6SUWZ6RkluYmZObqGBmZ6uanFxYnpqTm JScV6yfm5mxiBwcAABDsYvywLOMQoycGkJMpr+DwkUogvKT+lMiOxOCO+qDQntfgQowwHh5IE r/MroJxgUWp6akVaZg4wLGHSEhw8SiK8fSCtvMUFibnFmekQqVOMilLivFwgfQIgiYzSPLg2W CxcYpSVEuZlBDpEiKcgtSg3swRV/hWjOAejkjDv05dAU3gy80rgpr8CWswEtFh4BtjikkSElF QDoxO3eMx7zjPJ6nNdfkan3ymvz9p7Y+6Tk9rszH7Pvi/Iazqytfsy05kNW2++385fnvDYSc5 IKfCSxPX7i3QTjp4OE/Fl0+4KFmDQCmtlPPlQ9Zf2LVEPn+jfBRc8MkIEpHf9OWvw8nKvZcWZ RVdyWpqPPeqZE76qkzVlwuvO6s+bBVffWuW+XImlOCPRUIu5qDgRAOsztqKAAgAA X-Env-Sender: tianyu.lan@intel.com X-Msg-Ref: server-15.tower-21.messagelabs.com!1498737480!70758408!3 X-Originating-IP: [192.55.52.93] X-SpamReason: No, hits=0.0 required=7.0 tests=sa_preprocessor: VHJ1c3RlZCBJUDogMTkyLjU1LjUyLjkzID0+IDMyNDY2NQ==\n X-StarScan-Received: X-StarScan-Version: 9.4.25; banners=-,-,- X-VirusChecked: Checked Received: (qmail 34401 invoked from network); 29 Jun 2017 11:58:11 -0000 Received: from mga11.intel.com (HELO mga11.intel.com) (192.55.52.93) by server-15.tower-21.messagelabs.com with DHE-RSA-AES256-GCM-SHA384 encrypted SMTP; 29 Jun 2017 11:58:11 -0000 Received: from fmsmga003.fm.intel.com ([10.253.24.29]) by fmsmga102.fm.intel.com with ESMTP/TLS/DHE-RSA-AES256-GCM-SHA384; 29 Jun 2017 04:58:11 -0700 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.40,280,1496127600"; d="scan'208";a="873010526" Received: from sky-ws.sh.intel.com (HELO localhost) ([10.239.48.74]) by FMSMGA003.fm.intel.com with ESMTP; 29 Jun 2017 04:58:09 -0700 From: Lan Tianyu To: xen-devel@lists.xen.org Date: Thu, 29 Jun 2017 01:50:44 -0400 Message-Id: <1498715457-16565-13-git-send-email-tianyu.lan@intel.com> X-Mailer: git-send-email 1.8.3.1 In-Reply-To: <1498715457-16565-1-git-send-email-tianyu.lan@intel.com> References: <1498715457-16565-1-git-send-email-tianyu.lan@intel.com> Cc: Lan Tianyu , kevin.tian@intel.com, wei.liu2@citrix.com, andrew.cooper3@citrix.com, ian.jackson@eu.citrix.com, jbeulich@suse.com, Chao Gao Subject: [Xen-devel] [PATCH 12/25] X86/vvtd: Add MMIO handler for VVTD X-BeenThere: xen-devel@lists.xen.org X-Mailman-Version: 2.1.18 Precedence: list List-Id: Xen developer discussion List-Unsubscribe: , List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Errors-To: xen-devel-bounces@lists.xen.org Sender: "Xen-devel" X-Virus-Scanned: ClamAV using ClamSMTP From: Chao Gao This patch adds VVTD MMIO handler to deal with MMIO access. Signed-off-by: Chao Gao Signed-off-by: Lan Tianyu --- xen/drivers/passthrough/vtd/vvtd.c | 114 +++++++++++++++++++++++++++++++++++++ 1 file changed, 114 insertions(+) diff --git a/xen/drivers/passthrough/vtd/vvtd.c b/xen/drivers/passthrough/vtd/vvtd.c index a6735ca..0945970 100644 --- a/xen/drivers/passthrough/vtd/vvtd.c +++ b/xen/drivers/passthrough/vtd/vvtd.c @@ -50,6 +50,38 @@ struct vvtd { struct page_info *regs_page; }; +#define __DEBUG_VVTD__ +#ifdef __DEBUG_VVTD__ +extern unsigned int vvtd_debug_level; +#define VVTD_DBG_INFO 1 +#define VVTD_DBG_TRANS (1<<1) +#define VVTD_DBG_RW (1<<2) +#define VVTD_DBG_FAULT (1<<3) +#define VVTD_DBG_EOI (1<<4) +#define VVTD_DEBUG(lvl, _f, _a...) do { \ + if ( vvtd_debug_level & lvl ) \ + printk("VVTD %s:" _f "\n", __func__, ## _a); \ +} while(0) +#else +#define VVTD_DEBUG(fmt...) do {} while(0) +#endif + +unsigned int vvtd_debug_level __read_mostly; +integer_param("vvtd_debug", vvtd_debug_level); + +struct vvtd *domain_vvtd(struct domain *d) +{ + struct viommu_info *info = &d->viommu; + + BUILD_BUG_ON(NR_VIOMMU_PER_DOMAIN != 1); + return (info && info->viommu[0]) ? info->viommu[0]->priv : NULL; +} + +static inline struct vvtd *vcpu_vvtd(struct vcpu *v) +{ + return domain_vvtd(v->domain); +} + static inline void vvtd_set_reg(struct vvtd *vtd, uint32_t reg, uint32_t value) { @@ -76,6 +108,87 @@ static inline uint8_t vvtd_get_reg_byte(struct vvtd *vtd, uint32_t reg) vvtd_set_reg(vvtd, (reg) + 4, (val) >> 32); \ } while(0) +static int vvtd_range(struct vcpu *v, unsigned long addr) +{ + struct vvtd *vvtd = vcpu_vvtd(v); + + if ( vvtd ) + return (addr >= vvtd->base_addr) && + (addr < vvtd->base_addr + PAGE_SIZE); + return 0; +} + +static int vvtd_read(struct vcpu *v, unsigned long addr, + unsigned int len, unsigned long *pval) +{ + struct vvtd *vvtd = vcpu_vvtd(v); + unsigned int offset = addr - vvtd->base_addr; + unsigned int offset_aligned = offset & ~3; + + VVTD_DEBUG(VVTD_DBG_RW, "READ INFO: offset %x len %d.", offset, len); + + if ( !pval ) + return X86EMUL_UNHANDLEABLE; + + if ( (offset & 3) || ((len != 4) && (len != 8)) ) + { + VVTD_DEBUG(VVTD_DBG_RW, "Alignment or length is not canonical"); + return X86EMUL_UNHANDLEABLE; + } + + if ( len == 4 ) + *pval = vvtd_get_reg(vvtd, offset_aligned); + else + vvtd_get_reg_quad(vvtd, offset_aligned, *pval); + return X86EMUL_OKAY; +} + +static int vvtd_write(struct vcpu *v, unsigned long addr, + unsigned int len, unsigned long val) +{ + struct vvtd *vvtd = vcpu_vvtd(v); + unsigned int offset = addr - vvtd->base_addr; + unsigned int offset_aligned = offset & ~0x3; + int ret; + + VVTD_DEBUG(VVTD_DBG_RW, "WRITE INFO: offset %x len %d val %lx.", + offset, len, val); + + if ( (offset & 3) || ((len != 4) && (len != 8)) ) + { + VVTD_DEBUG(VVTD_DBG_RW, "Alignment or length is not canonical"); + return X86EMUL_UNHANDLEABLE; + } + + ret = X86EMUL_UNHANDLEABLE; + if ( len == 4 ) + { + switch ( offset_aligned ) + { + case DMAR_IEDATA_REG: + case DMAR_IEADDR_REG: + case DMAR_IEUADDR_REG: + case DMAR_FEDATA_REG: + case DMAR_FEADDR_REG: + case DMAR_FEUADDR_REG: + vvtd_set_reg(vvtd, offset_aligned, val); + ret = X86EMUL_OKAY; + break; + + default: + break; + } + } + + return ret; +} + +static const struct hvm_mmio_ops vvtd_mmio_ops = { + .check = vvtd_range, + .read = vvtd_read, + .write = vvtd_write +}; + static void vvtd_reset(struct vvtd *vvtd, uint64_t capability) { uint64_t cap, ecap; @@ -123,6 +236,7 @@ static int vvtd_create(struct domain *d, struct viommu *viommu) vvtd->length = viommu->length; vvtd->domain = d; vvtd->status = 0; + register_mmio_handler(d, &vvtd_mmio_ops); return 0; out2: