From: Tianrui Zhao <zhaotianrui@loongson.cn>
To: Paolo Bonzini <pbonzini@redhat.com>
Cc: Huacai Chen <chenhuacai@kernel.org>,
WANG Xuerui <kernel@xen0n.name>,
Greg Kroah-Hartman <gregkh@linuxfoundation.org>,
loongarch@lists.linux.dev, linux-kernel@vger.kernel.org,
kvm@vger.kernel.org, Jens Axboe <axboe@kernel.dk>,
Mark Brown <broonie@kernel.org>,
Alex Deucher <alexander.deucher@amd.com>,
Oliver Upton <oliver.upton@linux.dev>,
maobibo@loongson.cn, Xi Ruoyao <xry111@xry111.site>
Subject: [PATCH v4 20/29] LoongArch: KVM: Implement handle csr excption
Date: Tue, 21 Mar 2023 11:56:42 +0800 [thread overview]
Message-ID: <20230321035651.598505-21-zhaotianrui@loongson.cn> (raw)
In-Reply-To: <20230321035651.598505-1-zhaotianrui@loongson.cn>
Implement kvm handle loongarch vcpu exit caused by reading and
writing csr. Using loongarch_csr structure to emulate the registers.
Signed-off-by: Tianrui Zhao <zhaotianrui@loongson.cn>
---
arch/loongarch/include/asm/kvm_csr.h | 55 +++++++++++++++
arch/loongarch/kvm/exit.c | 100 +++++++++++++++++++++++++++
2 files changed, 155 insertions(+)
create mode 100644 arch/loongarch/include/asm/kvm_csr.h
create mode 100644 arch/loongarch/kvm/exit.c
diff --git a/arch/loongarch/include/asm/kvm_csr.h b/arch/loongarch/include/asm/kvm_csr.h
new file mode 100644
index 000000000..18052d0ad
--- /dev/null
+++ b/arch/loongarch/include/asm/kvm_csr.h
@@ -0,0 +1,55 @@
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Copyright (C) 2020-2023 Loongson Technology Corporation Limited
+ */
+
+#ifndef __ASM_LOONGARCH_KVM_CSR_H__
+#define __ASM_LOONGARCH_KVM_CSR_H__
+#include <asm/loongarch.h>
+#include <asm/kvm_host.h>
+#include <asm/kvm_vcpu.h>
+#include <linux/uaccess.h>
+#include <linux/kvm_host.h>
+
+#define kvm_read_hw_gcsr(id) gcsr_read(id)
+#define kvm_write_hw_gcsr(csr, id, val) gcsr_write(val, id)
+
+int _kvm_getcsr(struct kvm_vcpu *vcpu, unsigned int id, u64 *v);
+int _kvm_setcsr(struct kvm_vcpu *vcpu, unsigned int id, u64 v);
+
+int _kvm_emu_iocsr(larch_inst inst, struct kvm_run *run, struct kvm_vcpu *vcpu);
+
+static inline void kvm_save_hw_gcsr(struct loongarch_csrs *csr, int gid)
+{
+ csr->csrs[gid] = gcsr_read(gid);
+}
+
+static inline void kvm_restore_hw_gcsr(struct loongarch_csrs *csr, int gid)
+{
+ gcsr_write(csr->csrs[gid], gid);
+}
+
+static inline unsigned long kvm_read_sw_gcsr(struct loongarch_csrs *csr, int gid)
+{
+ return csr->csrs[gid];
+}
+
+static inline void kvm_write_sw_gcsr(struct loongarch_csrs *csr, int gid, unsigned long val)
+{
+ csr->csrs[gid] = val;
+}
+
+static inline void kvm_set_sw_gcsr(struct loongarch_csrs *csr, int gid, unsigned long val)
+{
+ csr->csrs[gid] |= val;
+}
+
+static inline void kvm_change_sw_gcsr(struct loongarch_csrs *csr, int gid, unsigned long mask,
+ unsigned long val)
+{
+ unsigned long _mask = mask;
+
+ csr->csrs[gid] &= ~_mask;
+ csr->csrs[gid] |= val & _mask;
+}
+#endif /* __ASM_LOONGARCH_KVM_CSR_H__ */
diff --git a/arch/loongarch/kvm/exit.c b/arch/loongarch/kvm/exit.c
new file mode 100644
index 000000000..dcb8eb815
--- /dev/null
+++ b/arch/loongarch/kvm/exit.c
@@ -0,0 +1,100 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright (C) 2020-2023 Loongson Technology Corporation Limited
+ */
+
+#include <linux/errno.h>
+#include <linux/err.h>
+#include <linux/module.h>
+#include <linux/preempt.h>
+#include <linux/vmalloc.h>
+#include <asm/fpu.h>
+#include <asm/inst.h>
+#include <asm/time.h>
+#include <asm/tlb.h>
+#include <asm/loongarch.h>
+#include <asm/numa.h>
+#include <asm/kvm_vcpu.h>
+#include <asm/kvm_csr.h>
+#include <linux/kvm_host.h>
+#include <asm/mmzone.h>
+
+#define CREATE_TRACE_POINTS
+#include "trace.h"
+
+static unsigned long _kvm_emu_read_csr(struct kvm_vcpu *vcpu, int csrid)
+{
+ struct loongarch_csrs *csr = vcpu->arch.csr;
+ unsigned long val = 0;
+
+ if (csrid < 4096 && (get_gcsr_flag(csrid) & SW_GCSR))
+ val = kvm_read_sw_gcsr(csr, csrid);
+ else
+ pr_warn_once("Unsupport csrread 0x%x with pc %lx\n",
+ csrid, vcpu->arch.pc);
+ return val;
+}
+
+static void _kvm_emu_write_csr(struct kvm_vcpu *vcpu, int csrid,
+ unsigned long val)
+{
+ struct loongarch_csrs *csr = vcpu->arch.csr;
+
+ if (csrid < 4096 && (get_gcsr_flag(csrid) & SW_GCSR))
+ kvm_write_sw_gcsr(csr, csrid, val);
+ else
+ pr_warn_once("Unsupport csrwrite 0x%x with pc %lx\n",
+ csrid, vcpu->arch.pc);
+}
+
+static void _kvm_emu_xchg_csr(struct kvm_vcpu *vcpu, int csrid,
+ unsigned long csr_mask, unsigned long val)
+{
+ struct loongarch_csrs *csr = vcpu->arch.csr;
+
+ if (csrid < 4096 && (get_gcsr_flag(csrid) & SW_GCSR)) {
+ unsigned long orig;
+
+ orig = kvm_read_sw_gcsr(csr, csrid);
+ orig &= ~csr_mask;
+ orig |= val & csr_mask;
+ kvm_write_sw_gcsr(csr, csrid, orig);
+ } else
+ pr_warn_once("Unsupport csrxchg 0x%x with pc %lx\n",
+ csrid, vcpu->arch.pc);
+}
+
+static int _kvm_handle_csr(struct kvm_vcpu *vcpu, larch_inst inst)
+{
+ unsigned int rd, rj, csrid;
+ unsigned long csr_mask;
+ unsigned long val = 0;
+
+ /*
+ * CSR value mask imm
+ * rj = 0 means csrrd
+ * rj = 1 means csrwr
+ * rj != 0,1 means csrxchg
+ */
+ rd = inst.reg2csr_format.rd;
+ rj = inst.reg2csr_format.rj;
+ csrid = inst.reg2csr_format.csr;
+
+ /* Process CSR ops */
+ if (rj == 0) {
+ /* process csrrd */
+ val = _kvm_emu_read_csr(vcpu, csrid);
+ vcpu->arch.gprs[rd] = val;
+ } else if (rj == 1) {
+ /* process csrwr */
+ val = vcpu->arch.gprs[rd];
+ _kvm_emu_write_csr(vcpu, csrid, val);
+ } else {
+ /* process csrxchg */
+ val = vcpu->arch.gprs[rd];
+ csr_mask = vcpu->arch.gprs[rj];
+ _kvm_emu_xchg_csr(vcpu, csrid, csr_mask, val);
+ }
+
+ return EMULATE_DONE;
+}
--
2.31.1
next prev parent reply other threads:[~2023-03-21 3:57 UTC|newest]
Thread overview: 34+ messages / expand[flat|nested] mbox.gz Atom feed top
2023-03-21 3:56 [PATCH v4 00/29] Add KVM LoongArch support Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 01/29] LoongArch: KVM: Add kvm related header files Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 02/29] LoongArch: KVM: Implement kvm module related interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 03/29] LoongArch: KVM: Implement kvm hardware enable, disable interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 04/29] LoongArch: KVM: Implement VM related functions Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 05/29] LoongArch: KVM: Add vcpu related header files Tianrui Zhao
2023-03-21 12:30 ` Xi Ruoyao
2023-03-22 1:34 ` Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 06/29] LoongArch: KVM: Implement vcpu create and destroy interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 07/29] LoongArch: KVM: Implement vcpu run interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 08/29] LoongArch: KVM: Implement vcpu handle exit interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 09/29] LoongArch: KVM: Implement vcpu get, vcpu set registers Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 10/29] LoongArch: KVM: Implement vcpu ENABLE_CAP ioctl interface Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 11/29] LoongArch: KVM: Implement fpu related operations for vcpu Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 12/29] LoongArch: KVM: Implement vcpu interrupt operations Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 13/29] LoongArch: KVM: Implement misc vcpu related interfaces Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 14/29] LoongArch: KVM: Implement vcpu load and vcpu put operations Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 15/29] LoongArch: KVM: Implement vcpu status description Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 16/29] LoongArch: KVM: Implement update VM id function Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 17/29] LoongArch: KVM: Implement virtual machine tlb operations Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 18/29] LoongArch: KVM: Implement vcpu timer operations Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 19/29] LoongArch: KVM: Implement kvm mmu operations Tianrui Zhao
2023-03-21 3:56 ` Tianrui Zhao [this message]
2023-03-21 3:56 ` [PATCH v4 21/29] LoongArch: KVM: Implement handle iocsr exception Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 22/29] LoongArch: KVM: Implement handle idle exception Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 23/29] LoongArch: KVM: Implement handle gspr exception Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 24/29] LoongArch: KVM: Implement handle mmio exception Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 25/29] LoongArch: KVM: Implement handle fpu exception Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 26/29] LoongArch: KVM: Implement kvm exception vector Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 27/29] LoongArch: KVM: Implement vcpu world switch Tianrui Zhao
2023-03-21 8:07 ` kernel test robot
2023-03-21 3:56 ` [PATCH v4 28/29] LoongArch: KVM: Implement probe virtualization when loongarch cpu init Tianrui Zhao
2023-03-21 3:56 ` [PATCH v4 29/29] LoongArch: KVM: Enable kvm config and add the makefile Tianrui Zhao
2023-03-21 8:48 ` kernel test robot
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20230321035651.598505-21-zhaotianrui@loongson.cn \
--to=zhaotianrui@loongson.cn \
--cc=alexander.deucher@amd.com \
--cc=axboe@kernel.dk \
--cc=broonie@kernel.org \
--cc=chenhuacai@kernel.org \
--cc=gregkh@linuxfoundation.org \
--cc=kernel@xen0n.name \
--cc=kvm@vger.kernel.org \
--cc=linux-kernel@vger.kernel.org \
--cc=loongarch@lists.linux.dev \
--cc=maobibo@loongson.cn \
--cc=oliver.upton@linux.dev \
--cc=pbonzini@redhat.com \
--cc=xry111@xry111.site \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).