vcpu.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2019 Western Digital Corporation or its affiliates.
  4. *
  5. * Authors:
  6. * Anup Patel <anup.patel@wdc.com>
  7. */
  8. #include <linux/bitops.h>
  9. #include <linux/entry-kvm.h>
  10. #include <linux/errno.h>
  11. #include <linux/err.h>
  12. #include <linux/kdebug.h>
  13. #include <linux/module.h>
  14. #include <linux/percpu.h>
  15. #include <linux/vmalloc.h>
  16. #include <linux/sched/signal.h>
  17. #include <linux/fs.h>
  18. #include <linux/kvm_host.h>
  19. #include <asm/csr.h>
  20. #include <asm/cacheflush.h>
  21. #include <asm/kvm_vcpu_vector.h>
  22. #define CREATE_TRACE_POINTS
  23. #include "trace.h"
  24. const struct _kvm_stats_desc kvm_vcpu_stats_desc[] = {
  25. KVM_GENERIC_VCPU_STATS(),
  26. STATS_DESC_COUNTER(VCPU, ecall_exit_stat),
  27. STATS_DESC_COUNTER(VCPU, wfi_exit_stat),
  28. STATS_DESC_COUNTER(VCPU, wrs_exit_stat),
  29. STATS_DESC_COUNTER(VCPU, mmio_exit_user),
  30. STATS_DESC_COUNTER(VCPU, mmio_exit_kernel),
  31. STATS_DESC_COUNTER(VCPU, csr_exit_user),
  32. STATS_DESC_COUNTER(VCPU, csr_exit_kernel),
  33. STATS_DESC_COUNTER(VCPU, signal_exits),
  34. STATS_DESC_COUNTER(VCPU, exits)
  35. };
  36. const struct kvm_stats_header kvm_vcpu_stats_header = {
  37. .name_size = KVM_STATS_NAME_SIZE,
  38. .num_desc = ARRAY_SIZE(kvm_vcpu_stats_desc),
  39. .id_offset = sizeof(struct kvm_stats_header),
  40. .desc_offset = sizeof(struct kvm_stats_header) + KVM_STATS_NAME_SIZE,
  41. .data_offset = sizeof(struct kvm_stats_header) + KVM_STATS_NAME_SIZE +
  42. sizeof(kvm_vcpu_stats_desc),
  43. };
  44. static void kvm_riscv_reset_vcpu(struct kvm_vcpu *vcpu)
  45. {
  46. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  47. struct kvm_vcpu_csr *reset_csr = &vcpu->arch.guest_reset_csr;
  48. struct kvm_cpu_context *cntx = &vcpu->arch.guest_context;
  49. struct kvm_cpu_context *reset_cntx = &vcpu->arch.guest_reset_context;
  50. bool loaded;
  51. /**
  52. * The preemption should be disabled here because it races with
  53. * kvm_sched_out/kvm_sched_in(called from preempt notifiers) which
  54. * also calls vcpu_load/put.
  55. */
  56. get_cpu();
  57. loaded = (vcpu->cpu != -1);
  58. if (loaded)
  59. kvm_arch_vcpu_put(vcpu);
  60. vcpu->arch.last_exit_cpu = -1;
  61. memcpy(csr, reset_csr, sizeof(*csr));
  62. spin_lock(&vcpu->arch.reset_cntx_lock);
  63. memcpy(cntx, reset_cntx, sizeof(*cntx));
  64. spin_unlock(&vcpu->arch.reset_cntx_lock);
  65. kvm_riscv_vcpu_fp_reset(vcpu);
  66. kvm_riscv_vcpu_vector_reset(vcpu);
  67. kvm_riscv_vcpu_timer_reset(vcpu);
  68. kvm_riscv_vcpu_aia_reset(vcpu);
  69. bitmap_zero(vcpu->arch.irqs_pending, KVM_RISCV_VCPU_NR_IRQS);
  70. bitmap_zero(vcpu->arch.irqs_pending_mask, KVM_RISCV_VCPU_NR_IRQS);
  71. kvm_riscv_vcpu_pmu_reset(vcpu);
  72. vcpu->arch.hfence_head = 0;
  73. vcpu->arch.hfence_tail = 0;
  74. memset(vcpu->arch.hfence_queue, 0, sizeof(vcpu->arch.hfence_queue));
  75. kvm_riscv_vcpu_sbi_sta_reset(vcpu);
  76. /* Reset the guest CSRs for hotplug usecase */
  77. if (loaded)
  78. kvm_arch_vcpu_load(vcpu, smp_processor_id());
  79. put_cpu();
  80. }
  81. int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id)
  82. {
  83. return 0;
  84. }
  85. int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu)
  86. {
  87. int rc;
  88. struct kvm_cpu_context *cntx;
  89. struct kvm_vcpu_csr *reset_csr = &vcpu->arch.guest_reset_csr;
  90. spin_lock_init(&vcpu->arch.mp_state_lock);
  91. /* Mark this VCPU never ran */
  92. vcpu->arch.ran_atleast_once = false;
  93. vcpu->arch.mmu_page_cache.gfp_zero = __GFP_ZERO;
  94. bitmap_zero(vcpu->arch.isa, RISCV_ISA_EXT_MAX);
  95. /* Setup ISA features available to VCPU */
  96. kvm_riscv_vcpu_setup_isa(vcpu);
  97. /* Setup vendor, arch, and implementation details */
  98. vcpu->arch.mvendorid = sbi_get_mvendorid();
  99. vcpu->arch.marchid = sbi_get_marchid();
  100. vcpu->arch.mimpid = sbi_get_mimpid();
  101. /* Setup VCPU hfence queue */
  102. spin_lock_init(&vcpu->arch.hfence_lock);
  103. /* Setup reset state of shadow SSTATUS and HSTATUS CSRs */
  104. spin_lock_init(&vcpu->arch.reset_cntx_lock);
  105. spin_lock(&vcpu->arch.reset_cntx_lock);
  106. cntx = &vcpu->arch.guest_reset_context;
  107. cntx->sstatus = SR_SPP | SR_SPIE;
  108. cntx->hstatus = 0;
  109. cntx->hstatus |= HSTATUS_VTW;
  110. cntx->hstatus |= HSTATUS_SPVP;
  111. cntx->hstatus |= HSTATUS_SPV;
  112. spin_unlock(&vcpu->arch.reset_cntx_lock);
  113. if (kvm_riscv_vcpu_alloc_vector_context(vcpu, cntx))
  114. return -ENOMEM;
  115. /* By default, make CY, TM, and IR counters accessible in VU mode */
  116. reset_csr->scounteren = 0x7;
  117. /* Setup VCPU timer */
  118. kvm_riscv_vcpu_timer_init(vcpu);
  119. /* setup performance monitoring */
  120. kvm_riscv_vcpu_pmu_init(vcpu);
  121. /* Setup VCPU AIA */
  122. rc = kvm_riscv_vcpu_aia_init(vcpu);
  123. if (rc)
  124. return rc;
  125. /*
  126. * Setup SBI extensions
  127. * NOTE: This must be the last thing to be initialized.
  128. */
  129. kvm_riscv_vcpu_sbi_init(vcpu);
  130. /* Reset VCPU */
  131. kvm_riscv_reset_vcpu(vcpu);
  132. return 0;
  133. }
  134. void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu)
  135. {
  136. /**
  137. * vcpu with id 0 is the designated boot cpu.
  138. * Keep all vcpus with non-zero id in power-off state so that
  139. * they can be brought up using SBI HSM extension.
  140. */
  141. if (vcpu->vcpu_idx != 0)
  142. kvm_riscv_vcpu_power_off(vcpu);
  143. }
  144. void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu)
  145. {
  146. /* Cleanup VCPU AIA context */
  147. kvm_riscv_vcpu_aia_deinit(vcpu);
  148. /* Cleanup VCPU timer */
  149. kvm_riscv_vcpu_timer_deinit(vcpu);
  150. kvm_riscv_vcpu_pmu_deinit(vcpu);
  151. /* Free unused pages pre-allocated for G-stage page table mappings */
  152. kvm_mmu_free_memory_cache(&vcpu->arch.mmu_page_cache);
  153. /* Free vector context space for host and guest kernel */
  154. kvm_riscv_vcpu_free_vector_context(vcpu);
  155. }
  156. int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu)
  157. {
  158. return kvm_riscv_vcpu_timer_pending(vcpu);
  159. }
  160. void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu)
  161. {
  162. kvm_riscv_aia_wakeon_hgei(vcpu, true);
  163. }
  164. void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu)
  165. {
  166. kvm_riscv_aia_wakeon_hgei(vcpu, false);
  167. }
  168. int kvm_arch_vcpu_runnable(struct kvm_vcpu *vcpu)
  169. {
  170. return (kvm_riscv_vcpu_has_interrupts(vcpu, -1UL) &&
  171. !kvm_riscv_vcpu_stopped(vcpu) && !vcpu->arch.pause);
  172. }
  173. int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu)
  174. {
  175. return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE;
  176. }
  177. bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu)
  178. {
  179. return (vcpu->arch.guest_context.sstatus & SR_SPP) ? true : false;
  180. }
  181. vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf)
  182. {
  183. return VM_FAULT_SIGBUS;
  184. }
  185. long kvm_arch_vcpu_async_ioctl(struct file *filp,
  186. unsigned int ioctl, unsigned long arg)
  187. {
  188. struct kvm_vcpu *vcpu = filp->private_data;
  189. void __user *argp = (void __user *)arg;
  190. if (ioctl == KVM_INTERRUPT) {
  191. struct kvm_interrupt irq;
  192. if (copy_from_user(&irq, argp, sizeof(irq)))
  193. return -EFAULT;
  194. if (irq.irq == KVM_INTERRUPT_SET)
  195. return kvm_riscv_vcpu_set_interrupt(vcpu, IRQ_VS_EXT);
  196. else
  197. return kvm_riscv_vcpu_unset_interrupt(vcpu, IRQ_VS_EXT);
  198. }
  199. return -ENOIOCTLCMD;
  200. }
  201. long kvm_arch_vcpu_ioctl(struct file *filp,
  202. unsigned int ioctl, unsigned long arg)
  203. {
  204. struct kvm_vcpu *vcpu = filp->private_data;
  205. void __user *argp = (void __user *)arg;
  206. long r = -EINVAL;
  207. switch (ioctl) {
  208. case KVM_SET_ONE_REG:
  209. case KVM_GET_ONE_REG: {
  210. struct kvm_one_reg reg;
  211. r = -EFAULT;
  212. if (copy_from_user(&reg, argp, sizeof(reg)))
  213. break;
  214. if (ioctl == KVM_SET_ONE_REG)
  215. r = kvm_riscv_vcpu_set_reg(vcpu, &reg);
  216. else
  217. r = kvm_riscv_vcpu_get_reg(vcpu, &reg);
  218. break;
  219. }
  220. case KVM_GET_REG_LIST: {
  221. struct kvm_reg_list __user *user_list = argp;
  222. struct kvm_reg_list reg_list;
  223. unsigned int n;
  224. r = -EFAULT;
  225. if (copy_from_user(&reg_list, user_list, sizeof(reg_list)))
  226. break;
  227. n = reg_list.n;
  228. reg_list.n = kvm_riscv_vcpu_num_regs(vcpu);
  229. if (copy_to_user(user_list, &reg_list, sizeof(reg_list)))
  230. break;
  231. r = -E2BIG;
  232. if (n < reg_list.n)
  233. break;
  234. r = kvm_riscv_vcpu_copy_reg_indices(vcpu, user_list->reg);
  235. break;
  236. }
  237. default:
  238. break;
  239. }
  240. return r;
  241. }
  242. int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
  243. struct kvm_sregs *sregs)
  244. {
  245. return -EINVAL;
  246. }
  247. int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
  248. struct kvm_sregs *sregs)
  249. {
  250. return -EINVAL;
  251. }
  252. int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  253. {
  254. return -EINVAL;
  255. }
  256. int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  257. {
  258. return -EINVAL;
  259. }
  260. int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
  261. struct kvm_translation *tr)
  262. {
  263. return -EINVAL;
  264. }
  265. int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  266. {
  267. return -EINVAL;
  268. }
  269. int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  270. {
  271. return -EINVAL;
  272. }
  273. void kvm_riscv_vcpu_flush_interrupts(struct kvm_vcpu *vcpu)
  274. {
  275. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  276. unsigned long mask, val;
  277. if (READ_ONCE(vcpu->arch.irqs_pending_mask[0])) {
  278. mask = xchg_acquire(&vcpu->arch.irqs_pending_mask[0], 0);
  279. val = READ_ONCE(vcpu->arch.irqs_pending[0]) & mask;
  280. csr->hvip &= ~mask;
  281. csr->hvip |= val;
  282. }
  283. /* Flush AIA high interrupts */
  284. kvm_riscv_vcpu_aia_flush_interrupts(vcpu);
  285. }
  286. void kvm_riscv_vcpu_sync_interrupts(struct kvm_vcpu *vcpu)
  287. {
  288. unsigned long hvip;
  289. struct kvm_vcpu_arch *v = &vcpu->arch;
  290. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  291. /* Read current HVIP and VSIE CSRs */
  292. csr->vsie = csr_read(CSR_VSIE);
  293. /* Sync-up HVIP.VSSIP bit changes does by Guest */
  294. hvip = csr_read(CSR_HVIP);
  295. if ((csr->hvip ^ hvip) & (1UL << IRQ_VS_SOFT)) {
  296. if (hvip & (1UL << IRQ_VS_SOFT)) {
  297. if (!test_and_set_bit(IRQ_VS_SOFT,
  298. v->irqs_pending_mask))
  299. set_bit(IRQ_VS_SOFT, v->irqs_pending);
  300. } else {
  301. if (!test_and_set_bit(IRQ_VS_SOFT,
  302. v->irqs_pending_mask))
  303. clear_bit(IRQ_VS_SOFT, v->irqs_pending);
  304. }
  305. }
  306. /* Sync up the HVIP.LCOFIP bit changes (only clear) by the guest */
  307. if ((csr->hvip ^ hvip) & (1UL << IRQ_PMU_OVF)) {
  308. if (!(hvip & (1UL << IRQ_PMU_OVF)) &&
  309. !test_and_set_bit(IRQ_PMU_OVF, v->irqs_pending_mask))
  310. clear_bit(IRQ_PMU_OVF, v->irqs_pending);
  311. }
  312. /* Sync-up AIA high interrupts */
  313. kvm_riscv_vcpu_aia_sync_interrupts(vcpu);
  314. /* Sync-up timer CSRs */
  315. kvm_riscv_vcpu_timer_sync(vcpu);
  316. }
  317. int kvm_riscv_vcpu_set_interrupt(struct kvm_vcpu *vcpu, unsigned int irq)
  318. {
  319. /*
  320. * We only allow VS-mode software, timer, and external
  321. * interrupts when irq is one of the local interrupts
  322. * defined by RISC-V privilege specification.
  323. */
  324. if (irq < IRQ_LOCAL_MAX &&
  325. irq != IRQ_VS_SOFT &&
  326. irq != IRQ_VS_TIMER &&
  327. irq != IRQ_VS_EXT &&
  328. irq != IRQ_PMU_OVF)
  329. return -EINVAL;
  330. set_bit(irq, vcpu->arch.irqs_pending);
  331. smp_mb__before_atomic();
  332. set_bit(irq, vcpu->arch.irqs_pending_mask);
  333. kvm_vcpu_kick(vcpu);
  334. return 0;
  335. }
  336. int kvm_riscv_vcpu_unset_interrupt(struct kvm_vcpu *vcpu, unsigned int irq)
  337. {
  338. /*
  339. * We only allow VS-mode software, timer, counter overflow and external
  340. * interrupts when irq is one of the local interrupts
  341. * defined by RISC-V privilege specification.
  342. */
  343. if (irq < IRQ_LOCAL_MAX &&
  344. irq != IRQ_VS_SOFT &&
  345. irq != IRQ_VS_TIMER &&
  346. irq != IRQ_VS_EXT &&
  347. irq != IRQ_PMU_OVF)
  348. return -EINVAL;
  349. clear_bit(irq, vcpu->arch.irqs_pending);
  350. smp_mb__before_atomic();
  351. set_bit(irq, vcpu->arch.irqs_pending_mask);
  352. return 0;
  353. }
  354. bool kvm_riscv_vcpu_has_interrupts(struct kvm_vcpu *vcpu, u64 mask)
  355. {
  356. unsigned long ie;
  357. ie = ((vcpu->arch.guest_csr.vsie & VSIP_VALID_MASK)
  358. << VSIP_TO_HVIP_SHIFT) & (unsigned long)mask;
  359. ie |= vcpu->arch.guest_csr.vsie & ~IRQ_LOCAL_MASK &
  360. (unsigned long)mask;
  361. if (READ_ONCE(vcpu->arch.irqs_pending[0]) & ie)
  362. return true;
  363. /* Check AIA high interrupts */
  364. return kvm_riscv_vcpu_aia_has_interrupts(vcpu, mask);
  365. }
  366. void __kvm_riscv_vcpu_power_off(struct kvm_vcpu *vcpu)
  367. {
  368. WRITE_ONCE(vcpu->arch.mp_state.mp_state, KVM_MP_STATE_STOPPED);
  369. kvm_make_request(KVM_REQ_SLEEP, vcpu);
  370. kvm_vcpu_kick(vcpu);
  371. }
  372. void kvm_riscv_vcpu_power_off(struct kvm_vcpu *vcpu)
  373. {
  374. spin_lock(&vcpu->arch.mp_state_lock);
  375. __kvm_riscv_vcpu_power_off(vcpu);
  376. spin_unlock(&vcpu->arch.mp_state_lock);
  377. }
  378. void __kvm_riscv_vcpu_power_on(struct kvm_vcpu *vcpu)
  379. {
  380. WRITE_ONCE(vcpu->arch.mp_state.mp_state, KVM_MP_STATE_RUNNABLE);
  381. kvm_vcpu_wake_up(vcpu);
  382. }
  383. void kvm_riscv_vcpu_power_on(struct kvm_vcpu *vcpu)
  384. {
  385. spin_lock(&vcpu->arch.mp_state_lock);
  386. __kvm_riscv_vcpu_power_on(vcpu);
  387. spin_unlock(&vcpu->arch.mp_state_lock);
  388. }
  389. bool kvm_riscv_vcpu_stopped(struct kvm_vcpu *vcpu)
  390. {
  391. return READ_ONCE(vcpu->arch.mp_state.mp_state) == KVM_MP_STATE_STOPPED;
  392. }
  393. int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu,
  394. struct kvm_mp_state *mp_state)
  395. {
  396. *mp_state = READ_ONCE(vcpu->arch.mp_state);
  397. return 0;
  398. }
  399. int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu,
  400. struct kvm_mp_state *mp_state)
  401. {
  402. int ret = 0;
  403. spin_lock(&vcpu->arch.mp_state_lock);
  404. switch (mp_state->mp_state) {
  405. case KVM_MP_STATE_RUNNABLE:
  406. WRITE_ONCE(vcpu->arch.mp_state, *mp_state);
  407. break;
  408. case KVM_MP_STATE_STOPPED:
  409. __kvm_riscv_vcpu_power_off(vcpu);
  410. break;
  411. default:
  412. ret = -EINVAL;
  413. }
  414. spin_unlock(&vcpu->arch.mp_state_lock);
  415. return ret;
  416. }
  417. int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
  418. struct kvm_guest_debug *dbg)
  419. {
  420. if (dbg->control & KVM_GUESTDBG_ENABLE) {
  421. vcpu->guest_debug = dbg->control;
  422. vcpu->arch.cfg.hedeleg &= ~BIT(EXC_BREAKPOINT);
  423. } else {
  424. vcpu->guest_debug = 0;
  425. vcpu->arch.cfg.hedeleg |= BIT(EXC_BREAKPOINT);
  426. }
  427. return 0;
  428. }
  429. static void kvm_riscv_vcpu_setup_config(struct kvm_vcpu *vcpu)
  430. {
  431. const unsigned long *isa = vcpu->arch.isa;
  432. struct kvm_vcpu_config *cfg = &vcpu->arch.cfg;
  433. if (riscv_isa_extension_available(isa, SVPBMT))
  434. cfg->henvcfg |= ENVCFG_PBMTE;
  435. if (riscv_isa_extension_available(isa, SSTC))
  436. cfg->henvcfg |= ENVCFG_STCE;
  437. if (riscv_isa_extension_available(isa, ZICBOM))
  438. cfg->henvcfg |= (ENVCFG_CBIE | ENVCFG_CBCFE);
  439. if (riscv_isa_extension_available(isa, ZICBOZ))
  440. cfg->henvcfg |= ENVCFG_CBZE;
  441. if (riscv_has_extension_unlikely(RISCV_ISA_EXT_SMSTATEEN)) {
  442. cfg->hstateen0 |= SMSTATEEN0_HSENVCFG;
  443. if (riscv_isa_extension_available(isa, SSAIA))
  444. cfg->hstateen0 |= SMSTATEEN0_AIA_IMSIC |
  445. SMSTATEEN0_AIA |
  446. SMSTATEEN0_AIA_ISEL;
  447. if (riscv_isa_extension_available(isa, SMSTATEEN))
  448. cfg->hstateen0 |= SMSTATEEN0_SSTATEEN0;
  449. }
  450. cfg->hedeleg = KVM_HEDELEG_DEFAULT;
  451. if (vcpu->guest_debug)
  452. cfg->hedeleg &= ~BIT(EXC_BREAKPOINT);
  453. }
  454. void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
  455. {
  456. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  457. struct kvm_vcpu_config *cfg = &vcpu->arch.cfg;
  458. csr_write(CSR_VSSTATUS, csr->vsstatus);
  459. csr_write(CSR_VSIE, csr->vsie);
  460. csr_write(CSR_VSTVEC, csr->vstvec);
  461. csr_write(CSR_VSSCRATCH, csr->vsscratch);
  462. csr_write(CSR_VSEPC, csr->vsepc);
  463. csr_write(CSR_VSCAUSE, csr->vscause);
  464. csr_write(CSR_VSTVAL, csr->vstval);
  465. csr_write(CSR_HEDELEG, cfg->hedeleg);
  466. csr_write(CSR_HVIP, csr->hvip);
  467. csr_write(CSR_VSATP, csr->vsatp);
  468. csr_write(CSR_HENVCFG, cfg->henvcfg);
  469. if (IS_ENABLED(CONFIG_32BIT))
  470. csr_write(CSR_HENVCFGH, cfg->henvcfg >> 32);
  471. if (riscv_has_extension_unlikely(RISCV_ISA_EXT_SMSTATEEN)) {
  472. csr_write(CSR_HSTATEEN0, cfg->hstateen0);
  473. if (IS_ENABLED(CONFIG_32BIT))
  474. csr_write(CSR_HSTATEEN0H, cfg->hstateen0 >> 32);
  475. }
  476. kvm_riscv_gstage_update_hgatp(vcpu);
  477. kvm_riscv_vcpu_timer_restore(vcpu);
  478. kvm_riscv_vcpu_host_fp_save(&vcpu->arch.host_context);
  479. kvm_riscv_vcpu_guest_fp_restore(&vcpu->arch.guest_context,
  480. vcpu->arch.isa);
  481. kvm_riscv_vcpu_host_vector_save(&vcpu->arch.host_context);
  482. kvm_riscv_vcpu_guest_vector_restore(&vcpu->arch.guest_context,
  483. vcpu->arch.isa);
  484. kvm_riscv_vcpu_aia_load(vcpu, cpu);
  485. kvm_make_request(KVM_REQ_STEAL_UPDATE, vcpu);
  486. vcpu->cpu = cpu;
  487. }
  488. void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu)
  489. {
  490. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  491. vcpu->cpu = -1;
  492. kvm_riscv_vcpu_aia_put(vcpu);
  493. kvm_riscv_vcpu_guest_fp_save(&vcpu->arch.guest_context,
  494. vcpu->arch.isa);
  495. kvm_riscv_vcpu_host_fp_restore(&vcpu->arch.host_context);
  496. kvm_riscv_vcpu_timer_save(vcpu);
  497. kvm_riscv_vcpu_guest_vector_save(&vcpu->arch.guest_context,
  498. vcpu->arch.isa);
  499. kvm_riscv_vcpu_host_vector_restore(&vcpu->arch.host_context);
  500. csr->vsstatus = csr_read(CSR_VSSTATUS);
  501. csr->vsie = csr_read(CSR_VSIE);
  502. csr->vstvec = csr_read(CSR_VSTVEC);
  503. csr->vsscratch = csr_read(CSR_VSSCRATCH);
  504. csr->vsepc = csr_read(CSR_VSEPC);
  505. csr->vscause = csr_read(CSR_VSCAUSE);
  506. csr->vstval = csr_read(CSR_VSTVAL);
  507. csr->hvip = csr_read(CSR_HVIP);
  508. csr->vsatp = csr_read(CSR_VSATP);
  509. }
  510. static void kvm_riscv_check_vcpu_requests(struct kvm_vcpu *vcpu)
  511. {
  512. struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu);
  513. if (kvm_request_pending(vcpu)) {
  514. if (kvm_check_request(KVM_REQ_SLEEP, vcpu)) {
  515. kvm_vcpu_srcu_read_unlock(vcpu);
  516. rcuwait_wait_event(wait,
  517. (!kvm_riscv_vcpu_stopped(vcpu)) && (!vcpu->arch.pause),
  518. TASK_INTERRUPTIBLE);
  519. kvm_vcpu_srcu_read_lock(vcpu);
  520. if (kvm_riscv_vcpu_stopped(vcpu) || vcpu->arch.pause) {
  521. /*
  522. * Awaken to handle a signal, request to
  523. * sleep again later.
  524. */
  525. kvm_make_request(KVM_REQ_SLEEP, vcpu);
  526. }
  527. }
  528. if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu))
  529. kvm_riscv_reset_vcpu(vcpu);
  530. if (kvm_check_request(KVM_REQ_UPDATE_HGATP, vcpu))
  531. kvm_riscv_gstage_update_hgatp(vcpu);
  532. if (kvm_check_request(KVM_REQ_FENCE_I, vcpu))
  533. kvm_riscv_fence_i_process(vcpu);
  534. /*
  535. * The generic KVM_REQ_TLB_FLUSH is same as
  536. * KVM_REQ_HFENCE_GVMA_VMID_ALL
  537. */
  538. if (kvm_check_request(KVM_REQ_HFENCE_GVMA_VMID_ALL, vcpu))
  539. kvm_riscv_hfence_gvma_vmid_all_process(vcpu);
  540. if (kvm_check_request(KVM_REQ_HFENCE_VVMA_ALL, vcpu))
  541. kvm_riscv_hfence_vvma_all_process(vcpu);
  542. if (kvm_check_request(KVM_REQ_HFENCE, vcpu))
  543. kvm_riscv_hfence_process(vcpu);
  544. if (kvm_check_request(KVM_REQ_STEAL_UPDATE, vcpu))
  545. kvm_riscv_vcpu_record_steal_time(vcpu);
  546. }
  547. }
  548. static void kvm_riscv_update_hvip(struct kvm_vcpu *vcpu)
  549. {
  550. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  551. csr_write(CSR_HVIP, csr->hvip);
  552. kvm_riscv_vcpu_aia_update_hvip(vcpu);
  553. }
  554. static __always_inline void kvm_riscv_vcpu_swap_in_guest_state(struct kvm_vcpu *vcpu)
  555. {
  556. struct kvm_vcpu_smstateen_csr *smcsr = &vcpu->arch.smstateen_csr;
  557. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  558. struct kvm_vcpu_config *cfg = &vcpu->arch.cfg;
  559. vcpu->arch.host_senvcfg = csr_swap(CSR_SENVCFG, csr->senvcfg);
  560. if (riscv_has_extension_unlikely(RISCV_ISA_EXT_SMSTATEEN) &&
  561. (cfg->hstateen0 & SMSTATEEN0_SSTATEEN0))
  562. vcpu->arch.host_sstateen0 = csr_swap(CSR_SSTATEEN0,
  563. smcsr->sstateen0);
  564. }
  565. static __always_inline void kvm_riscv_vcpu_swap_in_host_state(struct kvm_vcpu *vcpu)
  566. {
  567. struct kvm_vcpu_smstateen_csr *smcsr = &vcpu->arch.smstateen_csr;
  568. struct kvm_vcpu_csr *csr = &vcpu->arch.guest_csr;
  569. struct kvm_vcpu_config *cfg = &vcpu->arch.cfg;
  570. csr->senvcfg = csr_swap(CSR_SENVCFG, vcpu->arch.host_senvcfg);
  571. if (riscv_has_extension_unlikely(RISCV_ISA_EXT_SMSTATEEN) &&
  572. (cfg->hstateen0 & SMSTATEEN0_SSTATEEN0))
  573. smcsr->sstateen0 = csr_swap(CSR_SSTATEEN0,
  574. vcpu->arch.host_sstateen0);
  575. }
  576. /*
  577. * Actually run the vCPU, entering an RCU extended quiescent state (EQS) while
  578. * the vCPU is running.
  579. *
  580. * This must be noinstr as instrumentation may make use of RCU, and this is not
  581. * safe during the EQS.
  582. */
  583. static void noinstr kvm_riscv_vcpu_enter_exit(struct kvm_vcpu *vcpu)
  584. {
  585. kvm_riscv_vcpu_swap_in_guest_state(vcpu);
  586. guest_state_enter_irqoff();
  587. __kvm_riscv_switch_to(&vcpu->arch);
  588. vcpu->arch.last_exit_cpu = vcpu->cpu;
  589. guest_state_exit_irqoff();
  590. kvm_riscv_vcpu_swap_in_host_state(vcpu);
  591. }
  592. int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu)
  593. {
  594. int ret;
  595. struct kvm_cpu_trap trap;
  596. struct kvm_run *run = vcpu->run;
  597. if (!vcpu->arch.ran_atleast_once)
  598. kvm_riscv_vcpu_setup_config(vcpu);
  599. /* Mark this VCPU ran at least once */
  600. vcpu->arch.ran_atleast_once = true;
  601. kvm_vcpu_srcu_read_lock(vcpu);
  602. switch (run->exit_reason) {
  603. case KVM_EXIT_MMIO:
  604. /* Process MMIO value returned from user-space */
  605. ret = kvm_riscv_vcpu_mmio_return(vcpu, vcpu->run);
  606. break;
  607. case KVM_EXIT_RISCV_SBI:
  608. /* Process SBI value returned from user-space */
  609. ret = kvm_riscv_vcpu_sbi_return(vcpu, vcpu->run);
  610. break;
  611. case KVM_EXIT_RISCV_CSR:
  612. /* Process CSR value returned from user-space */
  613. ret = kvm_riscv_vcpu_csr_return(vcpu, vcpu->run);
  614. break;
  615. default:
  616. ret = 0;
  617. break;
  618. }
  619. if (ret) {
  620. kvm_vcpu_srcu_read_unlock(vcpu);
  621. return ret;
  622. }
  623. if (!vcpu->wants_to_run) {
  624. kvm_vcpu_srcu_read_unlock(vcpu);
  625. return -EINTR;
  626. }
  627. vcpu_load(vcpu);
  628. kvm_sigset_activate(vcpu);
  629. ret = 1;
  630. run->exit_reason = KVM_EXIT_UNKNOWN;
  631. while (ret > 0) {
  632. /* Check conditions before entering the guest */
  633. ret = xfer_to_guest_mode_handle_work(vcpu);
  634. if (ret)
  635. continue;
  636. ret = 1;
  637. kvm_riscv_gstage_vmid_update(vcpu);
  638. kvm_riscv_check_vcpu_requests(vcpu);
  639. preempt_disable();
  640. /* Update AIA HW state before entering guest */
  641. ret = kvm_riscv_vcpu_aia_update(vcpu);
  642. if (ret <= 0) {
  643. preempt_enable();
  644. continue;
  645. }
  646. local_irq_disable();
  647. /*
  648. * Ensure we set mode to IN_GUEST_MODE after we disable
  649. * interrupts and before the final VCPU requests check.
  650. * See the comment in kvm_vcpu_exiting_guest_mode() and
  651. * Documentation/virt/kvm/vcpu-requests.rst
  652. */
  653. vcpu->mode = IN_GUEST_MODE;
  654. kvm_vcpu_srcu_read_unlock(vcpu);
  655. smp_mb__after_srcu_read_unlock();
  656. /*
  657. * We might have got VCPU interrupts updated asynchronously
  658. * so update it in HW.
  659. */
  660. kvm_riscv_vcpu_flush_interrupts(vcpu);
  661. /* Update HVIP CSR for current CPU */
  662. kvm_riscv_update_hvip(vcpu);
  663. if (kvm_riscv_gstage_vmid_ver_changed(&vcpu->kvm->arch.vmid) ||
  664. kvm_request_pending(vcpu) ||
  665. xfer_to_guest_mode_work_pending()) {
  666. vcpu->mode = OUTSIDE_GUEST_MODE;
  667. local_irq_enable();
  668. preempt_enable();
  669. kvm_vcpu_srcu_read_lock(vcpu);
  670. continue;
  671. }
  672. /*
  673. * Cleanup stale TLB enteries
  674. *
  675. * Note: This should be done after G-stage VMID has been
  676. * updated using kvm_riscv_gstage_vmid_ver_changed()
  677. */
  678. kvm_riscv_local_tlb_sanitize(vcpu);
  679. trace_kvm_entry(vcpu);
  680. guest_timing_enter_irqoff();
  681. kvm_riscv_vcpu_enter_exit(vcpu);
  682. vcpu->mode = OUTSIDE_GUEST_MODE;
  683. vcpu->stat.exits++;
  684. /*
  685. * Save SCAUSE, STVAL, HTVAL, and HTINST because we might
  686. * get an interrupt between __kvm_riscv_switch_to() and
  687. * local_irq_enable() which can potentially change CSRs.
  688. */
  689. trap.sepc = vcpu->arch.guest_context.sepc;
  690. trap.scause = csr_read(CSR_SCAUSE);
  691. trap.stval = csr_read(CSR_STVAL);
  692. trap.htval = csr_read(CSR_HTVAL);
  693. trap.htinst = csr_read(CSR_HTINST);
  694. /* Syncup interrupts state with HW */
  695. kvm_riscv_vcpu_sync_interrupts(vcpu);
  696. /*
  697. * We must ensure that any pending interrupts are taken before
  698. * we exit guest timing so that timer ticks are accounted as
  699. * guest time. Transiently unmask interrupts so that any
  700. * pending interrupts are taken.
  701. *
  702. * There's no barrier which ensures that pending interrupts are
  703. * recognised, so we just hope that the CPU takes any pending
  704. * interrupts between the enable and disable.
  705. */
  706. local_irq_enable();
  707. local_irq_disable();
  708. guest_timing_exit_irqoff();
  709. local_irq_enable();
  710. trace_kvm_exit(&trap);
  711. preempt_enable();
  712. kvm_vcpu_srcu_read_lock(vcpu);
  713. ret = kvm_riscv_vcpu_exit(vcpu, run, &trap);
  714. }
  715. kvm_sigset_deactivate(vcpu);
  716. vcpu_put(vcpu);
  717. kvm_vcpu_srcu_read_unlock(vcpu);
  718. return ret;
  719. }