Implement virtual timer for secondary VMs.
If the timer fires while the secondary VM is running, the physical
interrupt will go to the primary VM, which should then run the secondary
again. Hafnium will then inject the virtual timer interrupt
automatically, and mask the timer interrupt so it doesn't immediately go
back to the primary. Note that the secondary must clear this mask before
it can get another timer interrupt.
Bug: 117271574
Change-Id: If90a3c4fd133333713ad6bf7d6a3b515ae6fea6a
diff --git a/src/arch/aarch64/BUILD.gn b/src/arch/aarch64/BUILD.gn
index 0f94b8d..2d6fdf9 100644
--- a/src/arch/aarch64/BUILD.gn
+++ b/src/arch/aarch64/BUILD.gn
@@ -41,6 +41,7 @@
"barriers.c",
"cpu.c",
"mm.c",
+ "timer.c",
]
}
diff --git a/src/arch/aarch64/timer.c b/src/arch/aarch64/timer.c
new file mode 100644
index 0000000..62375ba
--- /dev/null
+++ b/src/arch/aarch64/timer.c
@@ -0,0 +1,156 @@
+/*
+ * Copyright 2018 Google LLC
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * https://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "hf/arch/timer.h"
+
+#include <stdbool.h>
+#include <stddef.h>
+#include <stdint.h>
+
+#include "hf/arch/cpu.h"
+
+#include "hf/addr.h"
+
+#include "msr.h"
+
+#define CNTV_CTL_EL0_ENABLE (1u << 0)
+#define CNTV_CTL_EL0_IMASK (1u << 1)
+#define CNTV_CTL_EL0_ISTATUS (1u << 2)
+
+#define NANOS_PER_UNIT 1000000000
+
+/**
+ * Sets the bit to mask virtual timer interrupts.
+ */
+void arch_timer_mask(struct arch_regs *regs)
+{
+ regs->lazy.cntv_ctl_el0 |= CNTV_CTL_EL0_IMASK;
+}
+
+/**
+ * Checks whether the virtual timer is enabled and its interrupt not masked.
+ */
+bool arch_timer_enabled(struct arch_regs *regs)
+{
+ uintreg_t cntv_ctl_el0 = regs->lazy.cntv_ctl_el0;
+
+ return (cntv_ctl_el0 & CNTV_CTL_EL0_ENABLE) &&
+ !(cntv_ctl_el0 & CNTV_CTL_EL0_IMASK);
+}
+
+/**
+ * Converts a number of timer ticks to the equivalent number of nanoseconds.
+ */
+static uint64_t ticks_to_ns(uint64_t ticks)
+{
+ return (ticks * NANOS_PER_UNIT) / read_msr(cntfrq_el0);
+}
+
+/**
+ * Returns the number of ticks remaining on the virtual timer as stored in
+ * the given `arch_regs`, or 0 if it has already expired. This is undefined if
+ * the timer is not enabled.
+ */
+uint64_t arch_timer_remaining_ticks(struct arch_regs *regs)
+{
+ /*
+ * Calculate the value from the saved CompareValue (cntv_cval_el0) and
+ * the virtual count value.
+ */
+ uintreg_t cntv_cval_el0 = regs->lazy.cntv_cval_el0;
+ uintreg_t cntvct_el0 = read_msr(cntvct_el0);
+
+ if (cntv_cval_el0 >= cntvct_el0) {
+ return cntv_cval_el0 - cntvct_el0;
+ }
+
+ return 0;
+}
+
+/**
+ * Returns the number of nanoseconds remaining on the virtual timer as stored in
+ * the given `arch_regs`, or 0 if it has already expired. This is undefined if
+ * the timer is not enabled.
+ */
+uint64_t arch_timer_remaining_ns(struct arch_regs *regs)
+{
+ return ticks_to_ns(arch_timer_remaining_ticks(regs));
+}
+
+/**
+ * Returns whether the timer is ready to fire: i.e. it is enabled, not masked,
+ * and the condition is met.
+ */
+bool arch_timer_pending(struct arch_regs *regs)
+{
+ if (!arch_timer_enabled(regs)) {
+ return false;
+ }
+
+ if (regs->lazy.cntv_ctl_el0 & CNTV_CTL_EL0_ISTATUS) {
+ return true;
+ }
+
+ if (arch_timer_remaining_ticks(regs) == 0) {
+ /*
+ * This can happen even if the (stored) ISTATUS bit is not set,
+ * because time has passed between when the registers were
+ * stored and now.
+ */
+ return true;
+ }
+
+ return false;
+}
+
+/**
+ * Checks whether the virtual timer is enabled and its interrupt not masked, for
+ * the currently active vCPU.
+ */
+bool arch_timer_enabled_current(void)
+{
+ uintreg_t cntv_ctl_el0 = read_msr(cntv_ctl_el0);
+
+ return (cntv_ctl_el0 & CNTV_CTL_EL0_ENABLE) &&
+ !(cntv_ctl_el0 & CNTV_CTL_EL0_IMASK);
+}
+
+/**
+ * Returns the number of ticks remaining on the virtual timer of the currently
+ * active vCPU, or 0 if it has already expired. This is undefined if the timer
+ * is not enabled.
+ */
+uint64_t arch_timer_remaining_ticks_current(void)
+{
+ uintreg_t cntv_cval_el0 = read_msr(cntv_cval_el0);
+ uintreg_t cntvct_el0 = read_msr(cntvct_el0);
+
+ if (cntv_cval_el0 >= cntvct_el0) {
+ return cntv_cval_el0 - cntvct_el0;
+ }
+
+ return 0;
+}
+
+/**
+ * Returns the number of nanoseconds remaining on the virtual timer of the
+ * currently active vCPU, or 0 if it has already expired. This is undefined if
+ * the timer is not enabled.
+ */
+uint64_t arch_timer_remaining_ns_current(void)
+{
+ return ticks_to_ns(arch_timer_remaining_ticks_current());
+}
diff --git a/src/arch/fake/BUILD.gn b/src/arch/fake/BUILD.gn
index cc0a0ad..c3c404b 100644
--- a/src/arch/fake/BUILD.gn
+++ b/src/arch/fake/BUILD.gn
@@ -16,6 +16,7 @@
sources = [
"cpu.c",
"mm.c",
+ "timer.c",
]
}
diff --git a/src/arch/fake/timer.c b/src/arch/fake/timer.c
new file mode 100644
index 0000000..9e70daa
--- /dev/null
+++ b/src/arch/fake/timer.c
@@ -0,0 +1,61 @@
+/*
+ * Copyright 2018 Google LLC
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * https://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+#include "hf/arch/timer.h"
+
+#include <stdbool.h>
+#include <stdint.h>
+
+#include "hf/arch/types.h"
+
+bool arch_timer_pending(struct arch_regs *regs)
+{
+ /* TODO */
+ (void)regs;
+ return false;
+}
+
+void arch_timer_mask(struct arch_regs *regs)
+{
+ /* TODO */
+ (void)regs;
+}
+
+bool arch_timer_enabled(struct arch_regs *regs)
+{
+ /* TODO */
+ (void)regs;
+ return false;
+}
+
+uint64_t arch_timer_remaining_ns(struct arch_regs *regs)
+{
+ /* TODO */
+ (void)regs;
+ return 0;
+}
+
+bool arch_timer_enabled_current(void)
+{
+ /* TODO */
+ return false;
+}
+
+uint64_t arch_timer_remaining_ns_current(void)
+{
+ /* TODO */
+ return 0;
+}