Allocate the command queue and initialize related registers:
CBASER, CREADR, CWRITER.
The command queue is 64kB. This aims at not bothing with fullness.
Signed-off-by: Eric Auger <eric.auger@xxxxxxxxxx>
---
lib/arm/asm/gic-v3-its.h | 37 +++++++++++++++++++++++++++++++++++++
lib/arm/gic-v3-its.c | 35 +++++++++++++++++++++++++++++++++++
2 files changed, 72 insertions(+)
diff --git a/lib/arm/asm/gic-v3-its.h b/lib/arm/asm/gic-v3-its.h
index 6fd5d6d..21054cb 100644
--- a/lib/arm/asm/gic-v3-its.h
+++ b/lib/arm/asm/gic-v3-its.h
@@ -33,8 +33,35 @@
#define GICR_PROPBASER_InnerShareable \
GIC_BASER_SHAREABILITY(GICR_PROPBASER, InnerShareable)
+#define GITS_CBASER 0x0080
+#define GITS_CWRITER 0x0088
+#define GITS_CREADR 0x0090
#define GITS_BASER 0x0100
+#define GITS_CBASER_VALID (1UL << 63)
+#define GITS_CBASER_SHAREABILITY_SHIFT (10)
+#define GITS_CBASER_INNER_CACHEABILITY_SHIFT (59)
+#define GITS_CBASER_OUTER_CACHEABILITY_SHIFT (53)
+#define GITS_CBASER_SHAREABILITY_MASK \
+ GIC_BASER_SHAREABILITY(GITS_CBASER, SHAREABILITY_MASK)
+#define GITS_CBASER_INNER_CACHEABILITY_MASK \
+ GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, MASK)
+#define GITS_CBASER_OUTER_CACHEABILITY_MASK \
+ GIC_BASER_CACHEABILITY(GITS_CBASER, OUTER, MASK)
+#define GITS_CBASER_CACHEABILITY_MASK GITS_CBASER_INNER_CACHEABILITY_MASK
+
+#define GITS_CBASER_InnerShareable \
+ GIC_BASER_SHAREABILITY(GITS_CBASER, InnerShareable)
+
+#define GITS_CBASER_nCnB GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nCnB)
+#define GITS_CBASER_nC GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, nC)
+#define GITS_CBASER_RaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWt)
+#define GITS_CBASER_RaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWt)
+#define GITS_CBASER_WaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWt)
+#define GITS_CBASER_WaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, WaWb)
+#define GITS_CBASER_RaWaWt GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWt)
+#define GITS_CBASER_RaWaWb GIC_BASER_CACHEABILITY(GITS_CBASER, INNER, RaWaWb)
+
#define GITS_BASER_NR_REGS 8
#define GITS_BASER_VALID (1UL << 63)
@@ -84,6 +111,8 @@
#define GITS_BASER_TYPE_RESERVED6 6
#define GITS_BASER_TYPE_RESERVED7 7
+#define ITS_FLAGS_CMDQ_NEEDS_FLUSHING (1ULL << 0)
+
struct its_baser {
unsigned int index;
int type;
@@ -97,9 +126,17 @@ struct its_baser {
int esz;
};
+struct its_cmd_block {
+ u64 raw_cmd[4];
+};
+
struct its_data {
void *base;
+ struct its_cmd_block *cmd_base;
+ struct its_cmd_block *cmd_write;
+ struct its_cmd_block *cmd_readr;
struct its_baser baser[GITS_BASER_NR_REGS];
+ u64 flags;
};
extern struct its_data its_data;
diff --git a/lib/arm/gic-v3-its.c b/lib/arm/gic-v3-its.c
index 5eb8e6a..f577d5f 100644
--- a/lib/arm/gic-v3-its.c
+++ b/lib/arm/gic-v3-its.c
@@ -136,3 +136,38 @@ void alloc_lpi_tables(void)
writeq(pend_val, ptr + GICR_PENDBASER);
}
}
+
+/**
+ * init_cmd_queue: Allocate the command queue and initialize
+ * CBASER, CREADR, CWRITER
+ */
+void init_cmd_queue(void)
+{
+ u64 cbaser, tmp;
+
+ its_data.cmd_base = (void *)phys_zalloc_aligned(SZ_64K, SZ_64K);
+
+ cbaser = ((u64)its_data.cmd_base |
+ GITS_CBASER_WaWb |
+ GITS_CBASER_InnerShareable |
+ (SZ_64K / SZ_4K - 1) |
+ GITS_CBASER_VALID);
+
+ writeq(cbaser, its_data.base + GITS_CBASER);
+ tmp = readq(its_data.base + GITS_CBASER);
+
+ if ((tmp ^ cbaser) & GITS_CBASER_SHAREABILITY_MASK) {
+ if (!(tmp & GITS_CBASER_SHAREABILITY_MASK)) {
+ cbaser &= ~(GITS_CBASER_SHAREABILITY_MASK |
+ GITS_CBASER_CACHEABILITY_MASK);
+ cbaser |= GITS_CBASER_nC;
+ writeq(cbaser, its_data.base + GITS_CBASER);
+ }
+ its_data.flags |= ITS_FLAGS_CMDQ_NEEDS_FLUSHING;
+ }
+
+ its_data.cmd_write = its_data.cmd_base;
+ its_data.cmd_readr = its_data.cmd_base;
+ writeq(0, its_data.base + GITS_CWRITER);
+ writeq(0, its_data.base + GITS_CREADR);
+}
--
2.5.5
--
To unsubscribe from this list: send the line "unsubscribe kvm" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
