summaryrefslogtreecommitdiff
path: root/src/drivers/gic/gic.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/drivers/gic/gic.c')
-rw-r--r--src/drivers/gic/gic.c120
1 files changed, 120 insertions, 0 deletions
diff --git a/src/drivers/gic/gic.c b/src/drivers/gic/gic.c
new file mode 100644
index 0000000000..885d2216be
--- /dev/null
+++ b/src/drivers/gic/gic.c
@@ -0,0 +1,120 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright 2014 Google Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ */
+
+#include <arch/cpu.h>
+#include <arch/io.h>
+#include <console/console.h>
+#include <gic.h>
+#include "gic.h"
+
+enum {
+ ENABLE_GRP0 = 0x1 << 0,
+ ENABLE_GRP1 = 0x1 << 1,
+};
+
+struct gic {
+ struct gicd_mmio *gicd;
+ struct gicc_mmio *gicc;
+ size_t num_interrupts;
+ unsigned int version;
+ unsigned int security_extensions;
+};
+
+static struct gic *gic_get(void)
+{
+ static struct gic gic;
+
+ if (gic.gicd == NULL) {
+ uint32_t typer;
+
+ gic.gicd = gicd_base();
+ gic.gicc = gicc_base();
+ typer = read32(&gic.gicd->typer);
+ gic.num_interrupts = 32 * ((typer & 0x1f) + 1);
+ gic.security_extensions = !!(typer & (1 << 10));
+ gic.version = (read32(&gic.gicd->icpidr2) & 0xf0) >> 4;
+
+ printk(BIOS_DEBUG, "GICv%d - %zu ints %s GICD=%p GICC=%p\n",
+ gic.version, gic.num_interrupts,
+ gic.security_extensions ? "SecExtn" : "",
+ gic.gicd, gic.gicc);
+ }
+
+ return &gic;
+}
+
+static inline void gic_write(uint32_t *base, uint32_t val)
+{
+ write32(val, base);
+}
+
+static void gic_write_regs(uint32_t *base, size_t num_regs, uint32_t val)
+{
+ size_t i;
+
+ for (i = 0; i < num_regs; i++)
+ gic_write(base++, val);
+}
+
+static void gic_write_banked_regs(uint32_t *base, size_t interrupts_per_reg,
+ uint32_t val)
+{
+ /* 1st 32 interrupts are banked per CPU. */
+ gic_write_regs(base, 32 / interrupts_per_reg, val);
+}
+
+void gic_init(void)
+{
+ struct gic *gic;
+ struct gicd_mmio *gicd;
+ struct gicc_mmio *gicc;
+ uint32_t cpu_mask;
+
+ gic = gic_get();
+ gicd = gic->gicd;
+ gicc = gic->gicc;
+
+ /* Enable Group 0 and Group 1 in GICD -- banked regs. */
+ gic_write(&gicd->ctlr, ENABLE_GRP0 | ENABLE_GRP1);
+
+ /* Enable Group 0 and Group 1 in GICC and enable all priroity levels. */
+ gic_write(&gicc->ctlr, ENABLE_GRP0 | ENABLE_GRP1);
+ gic_write(&gicc->pmr, 1 << 7);
+
+ cpu_mask = 1 << smp_processor_id();
+ cpu_mask |= cpu_mask << 8;
+ cpu_mask |= cpu_mask << 16;
+
+ /* Only write banked registers for secondary CPUs. */
+ if (smp_processor_id()) {
+ gic_write_banked_regs(&gicd->itargetsr[0], 4, cpu_mask);
+ /* Put interrupts into Group 1. */
+ gic_write_banked_regs(&gicd->igroupr[0], 32, ~0x0);
+ /* Allow Non-secure access to everything. */
+ gic_write_banked_regs(&gicd->nsacr[0], 16, ~0x0);
+ return;
+ }
+
+ /* All interrupts routed to processors that execute this function. */
+ gic_write_regs(&gicd->itargetsr[0], gic->num_interrupts / 4, cpu_mask);
+ /* Put all interrupts into Gropup 1. */
+ gic_write_regs(&gicd->igroupr[0], gic->num_interrupts / 32, ~0x0);
+ /* Allow Non-secure access to everything. */
+ gic_write_regs(&gicd->nsacr[0], gic->num_interrupts / 16, ~0x0);
+}