From patchwork Fri Sep 22 03:01:53 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: "lan,Tianyu" X-Patchwork-Id: 9965581 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 D68AD600C5 for ; Fri, 22 Sep 2017 09:12:13 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id D09E028501 for ; Fri, 22 Sep 2017 09:12:13 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id C56FA28757; Fri, 22 Sep 2017 09:12:13 +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 6DCB728501 for ; Fri, 22 Sep 2017 09:12:13 +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 1dvJyP-00044T-08; Fri, 22 Sep 2017 09:10: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 1dvJyN-000439-Jm for xen-devel@lists.xen.org; Fri, 22 Sep 2017 09:10:11 +0000 Received: from [85.158.143.35] by server-5.bemta-6.messagelabs.com id 4C/F5-03454-273D4C95; Fri, 22 Sep 2017 09:10:10 +0000 X-Brightmail-Tracker: H4sIAAAAAAAAA+NgFvrNLMWRWlGSWpSXmKPExsXS1tYhr1t0+Ui kwZXZchZLPi5mcWD0OLr7N1MAYxRrZl5SfkUCa8a/KQcZC/7KVKxfcJetgfGHaBcjJ4eQQKXE 7u617CC2hACvxJFlM1gh7ACJ54u3MHcxcgHVdDBK7P80mxkkwSagLnFi8URGEFtEQFri2ufLj CBFzAKbmSTmrpnFApIQFrCV+NfyGmwqi4CqxLwdq8EaeAVcJTYc+c8GsUFBYsrD92BDOYHiv/ q2M0Fc5CLRunQ/0wRG3gWMDKsYNYpTi8pSi3QNjfSSijLTM0pyEzNzdA0NzPRyU4uLE9NTcxK TivWS83M3MQIDggEIdjBe3hhwiFGSg0lJlPf9+SORQnxJ+SmVGYnFGfFFpTmpxYcYZTg4lCR4 /S4B5QSLUtNTK9Iyc4ChCZOW4OBREuFVA0nzFhck5hZnpkOkTjHqcnTcvPuHSYglLz8vVUqcV w+kSACkKKM0D24ELE4uMcpKCfMyAh0lxFOQWpSbWYIq/4pRnINRSZjXAGQKT2ZeCdymV0BHMA EdUb4a7IiSRISUVAOjoVhKz8sDV7Kzs5TEKiw3Kv191hfwPnESn1y0q8r79f8Wlj/ZHwm0QO3 pewuTx+FGR5vufFn12kXkzMuS7iUP/SpnJXydEup7uPJ31Zcdkf8FZBkNjjQcdLb+bFKwhOXV NUOBE7Mv5Ahubv/VnCh7cMaes9Fz5rwzVT6/V/N86B6WiYu8gw4psRRnJBpqMRcVJwIAs2zb6 44CAAA= X-Env-Sender: tianyu.lan@intel.com X-Msg-Ref: server-13.tower-21.messagelabs.com!1506071404!78232916!2 X-Originating-IP: [134.134.136.31] X-SpamReason: No, hits=1.3 required=7.0 tests=BODY_RANDOM_LONG, DATE_IN_PAST_06_12 X-StarScan-Received: X-StarScan-Version: 9.4.45; banners=-,-,- X-VirusChecked: Checked Received: (qmail 30993 invoked from network); 22 Sep 2017 09:10:10 -0000 Received: from mga06.intel.com (HELO mga06.intel.com) (134.134.136.31) by server-13.tower-21.messagelabs.com with DHE-RSA-AES256-GCM-SHA384 encrypted SMTP; 22 Sep 2017 09:10:10 -0000 Received: from fmsmga001.fm.intel.com ([10.253.24.23]) by orsmga104.jf.intel.com with ESMTP; 22 Sep 2017 02:10:09 -0700 X-ExtLoop1: 1 X-IronPort-AV: E=Sophos; i="5.42,427,1500966000"; d="scan'208"; a="1197902126" Received: from sky-ws.sh.intel.com (HELO localhost) ([10.239.48.141]) by fmsmga001.fm.intel.com with ESMTP; 22 Sep 2017 02:10:07 -0700 From: Lan Tianyu To: xen-devel@lists.xen.org Date: Thu, 21 Sep 2017 23:01:53 -0400 Message-Id: <1506049330-11196-13-git-send-email-tianyu.lan@intel.com> X-Mailer: git-send-email 1.8.3.1 In-Reply-To: <1506049330-11196-1-git-send-email-tianyu.lan@intel.com> References: <1506049330-11196-1-git-send-email-tianyu.lan@intel.com> Cc: Lan Tianyu , kevin.tian@intel.com, sstabellini@kernel.org, wei.liu2@citrix.com, George.Dunlap@eu.citrix.com, andrew.cooper3@citrix.com, ian.jackson@eu.citrix.com, tim@xen.org, jbeulich@suse.com, roger.pau@citrix.com, Chao Gao Subject: [Xen-devel] [PATCH V3 12/29] 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 | 91 ++++++++++++++++++++++++++++++++++++++ 1 file changed, 91 insertions(+) diff --git a/xen/drivers/passthrough/vtd/vvtd.c b/xen/drivers/passthrough/vtd/vvtd.c index c851ec7..a3002c3 100644 --- a/xen/drivers/passthrough/vtd/vvtd.c +++ b/xen/drivers/passthrough/vtd/vvtd.c @@ -47,6 +47,29 @@ struct vvtd { struct page_info *regs_page; }; +/* Setting viommu_verbose enables debugging messages of vIOMMU */ +bool __read_mostly viommu_verbose; +boolean_runtime_param("viommu_verbose", viommu_verbose); + +#ifndef NDEBUG +#define vvtd_info(fmt...) do { \ + if ( viommu_verbose ) \ + gprintk(XENLOG_G_INFO, ## fmt); \ +} while(0) +#define vvtd_debug(fmt...) do { \ + if ( viommu_verbose && printk_ratelimit() ) \ + printk(XENLOG_G_DEBUG fmt); \ +} while(0) +#else +#define vvtd_info(fmt...) do {} while(0) +#define vvtd_debug(fmt...) do {} while(0) +#endif + +struct vvtd *domain_vvtd(struct domain *d) +{ + return (d->viommu) ? d->viommu->priv : NULL; +} + static inline void vvtd_set_reg(struct vvtd *vtd, uint32_t reg, uint32_t value) { vtd->regs->data32[reg/sizeof(uint32_t)] = value; @@ -68,6 +91,73 @@ static inline uint64_t vvtd_get_reg_quad(struct vvtd *vtd, uint32_t reg) return vtd->regs->data64[reg/sizeof(uint64_t)]; } +static int vvtd_in_range(struct vcpu *v, unsigned long addr) +{ + struct vvtd *vvtd = domain_vvtd(v->domain); + + 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 = domain_vvtd(v->domain); + unsigned int offset = addr - vvtd->base_addr; + + vvtd_info("Read offset %x len %d\n", offset, len); + + if ( (len != 4 && len != 8) || (offset & (len - 1)) ) + return X86EMUL_OKAY; + + if ( len == 4 ) + *pval = vvtd_get_reg(vvtd, offset); + else + *pval = vvtd_get_reg_quad(vvtd, offset); + + return X86EMUL_OKAY; +} + +static int vvtd_write(struct vcpu *v, unsigned long addr, + unsigned int len, unsigned long val) +{ + struct vvtd *vvtd = domain_vvtd(v->domain); + unsigned int offset = addr - vvtd->base_addr; + + vvtd_info("Write offset %x len %d val %lx\n", offset, len, val); + + if ( (len != 4 && len != 8) || (offset & (len - 1)) ) + return X86EMUL_OKAY; + + if ( len == 4 ) + { + switch ( offset ) + { + 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, val); + break; + + default: + break; + } + } + + return X86EMUL_OKAY; +} + +static const struct hvm_mmio_ops vvtd_mmio_ops = { + .check = vvtd_in_range, + .read = vvtd_read, + .write = vvtd_write +}; + static void vvtd_reset(struct vvtd *vvtd, uint64_t capability) { uint64_t cap = cap_set_num_fault_regs(1ULL) | @@ -109,6 +199,7 @@ static int vvtd_create(struct domain *d, struct viommu *viommu) vvtd_reset(vvtd, viommu->caps); vvtd->base_addr = viommu->base_address; vvtd->domain = d; + register_mmio_handler(d, &vvtd_mmio_ops); viommu->priv = vvtd;