From: Wei Chen <Wei.Chen@xxxxxxx>
Sometimes, for debug purpose, we would like to dump the
registers' value while exception happened. This patch add
a function to dump registers. Currently, we haven't enable
the interrupt controller, so any exception is not expected.
So any exception will cause registers dump.
Signed-off-by: Wei Chen <Wei.Chen@xxxxxxx>
---
plat/common/arm/traps.c | 71 +++++++++++++++++++++++++++++++++++++++++
plat/kvm/Makefile.uk | 1 +
2 files changed, 72 insertions(+)
create mode 100644 plat/common/arm/traps.c
diff --git a/plat/common/arm/traps.c b/plat/common/arm/traps.c
new file mode 100644
index 0000000..d80be6c
--- /dev/null
+++ b/plat/common/arm/traps.c
@@ -0,0 +1,71 @@
+/* SPDX-License-Identifier: ISC */
+/*
+ * Authors: Wei Chen <Wei.Chen@xxxxxxx>
+ *
+ * Copyright (c) 2018 Arm Ltd.
+ *
+ * Permission to use, copy, modify, and/or distribute this software
+ * for any purpose with or without fee is hereby granted, provided
+ * that the above copyright notice and this permission notice appear
+ * in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
+ * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
+ * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
+ * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR
+ * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS
+ * OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
+ * NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
+ * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <stdint.h>
+#include <string.h>
+#include <uk/print.h>
+#include <uk/assert.h>
+
+static const char *exception_modes[]= {
+ "Synchronous Abort",
+ "IRQ",
+ "FIQ",
+ "Error"
+};
+
+static void dump_registers(struct __regs *regs, uint64_t far)
+{
+ unsigned char idx;
+
+ uk_printd(DLVL_CRIT, "Unikraft: Dump registers:\n");
+ uk_printd(DLVL_CRIT, "\t SP : 0x%016lx\n", regs->sp);
+ uk_printd(DLVL_CRIT, "\t ESR_EL1 : 0x%016lx\n", regs->esr_el1);
+ uk_printd(DLVL_CRIT, "\t ELR_EL1 : 0x%016lx\n", regs->elr_el1);
+ uk_printd(DLVL_CRIT, "\t LR (x30) : 0x%016lx\n", regs->lr);
+ uk_printd(DLVL_CRIT, "\t PSTATE : 0x%016lx\n", regs->spsr_el1);
+ uk_printd(DLVL_CRIT, "\t FAR_EL1 : 0x%016lx\n", far);
+
+ for (idx = 0; idx < 28; idx += 4)
+ uk_printd(DLVL_CRIT,
+ "\t x%02d ~ x%02d: 0x%016lx 0x%016lx 0x%016lx
0x%016lx\n",
+ idx, idx + 3, regs->x[idx], regs->x[idx + 1],
+ regs->x[idx + 2], regs->x[idx + 3]);
+
+ uk_printd(DLVL_CRIT, "\t x28 ~ x29: 0x%016lx 0x%016lx\n",
+ regs->x[28], regs->x[29]);
+}
+
+void invalid_trap_handler(struct __regs *regs, uint32_t el,
+ uint32_t reason, uint64_t far)
+{
+ uk_printd(DLVL_CRIT, "Unikraft: EL%d invalid %s trap caught\n",
+ el, exception_modes[reason]);
+ dump_registers(regs, far);
+ ukplat_crash();
+}
+
+void trap_el1_sync(struct __regs *regs, uint64_t far)
+{
+ uk_printd(DLVL_CRIT, "Unikraft: EL1 sync trap caught\n");
+
+ dump_registers(regs, far);
+ ukplat_crash();
+}
diff --git a/plat/kvm/Makefile.uk b/plat/kvm/Makefile.uk
index ba681f5..c3b2f93 100644
--- a/plat/kvm/Makefile.uk
+++ b/plat/kvm/Makefile.uk
@@ -56,6 +56,7 @@ LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) +=
$(UK_PLAT_COMMON_BASE)/arm/pl011.c|comm
endif
LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) +=
$(UK_PLAT_COMMON_BASE)/arm/cache64.S|common
LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) +=
$(UK_PLAT_COMMON_BASE)/arm/time.c|common
+LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) +=
$(UK_PLAT_COMMON_BASE)/arm/traps.c|common
LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) += $(LIBKVMPLAT_BASE)/arm/entry64.S
LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) += $(LIBKVMPLAT_BASE)/arm/setup.c
LIBKVMPLAT_SRCS-$(CONFIG_ARCH_ARM_64) += $(LIBKVMPLAT_BASE)/arm/lcpu.c
