[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]
[kvm-unit-tests PATCH v2 08/16] arm/arm64: ITS: Init the command queue
From: |
Eric Auger |
Subject: |
[kvm-unit-tests PATCH v2 08/16] arm/arm64: ITS: Init the command queue |
Date: |
Fri, 10 Jan 2020 15:54:04 +0100 |
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 <address@hidden>
---
v2 -> v3:
- removed readr
---
lib/arm/asm/gic-v3-its.h | 6 ++++++
lib/arm/gic-v3-its.c | 22 ++++++++++++++++++++++
2 files changed, 28 insertions(+)
diff --git a/lib/arm/asm/gic-v3-its.h b/lib/arm/asm/gic-v3-its.h
index 2f8b8f1..93814f7 100644
--- a/lib/arm/asm/gic-v3-its.h
+++ b/lib/arm/asm/gic-v3-its.h
@@ -75,10 +75,16 @@ struct its_baser {
int esz;
};
+struct its_cmd_block {
+ u64 raw_cmd[4];
+};
+
struct its_data {
void *base;
struct its_typer typer;
struct its_baser baser[GITS_BASER_NR_REGS];
+ struct its_cmd_block *cmd_base;
+ struct its_cmd_block *cmd_write;
};
extern struct its_data its_data;
diff --git a/lib/arm/gic-v3-its.c b/lib/arm/gic-v3-its.c
index 6c97569..3037c84 100644
--- a/lib/arm/gic-v3-its.c
+++ b/lib/arm/gic-v3-its.c
@@ -177,3 +177,25 @@ void set_pending_table_bit(int rdist, int n, bool set)
byte &= ~mask;
*ptr = byte;
}
+
+/**
+ * init_cmd_queue: Allocate the command queue and initialize
+ * CBASER, CREADR, CWRITER
+ */
+void init_cmd_queue(void);
+void init_cmd_queue(void)
+{
+ unsigned long n = SZ_64K >> PAGE_SHIFT;
+ unsigned long order = fls(n);
+ u64 cbaser;
+
+ its_data.cmd_base = (void *)virt_to_phys(alloc_pages(order));
+
+ cbaser = ((u64)its_data.cmd_base | (SZ_64K / SZ_4K - 1) |
+ GITS_CBASER_VALID);
+
+ writeq(cbaser, its_data.base + GITS_CBASER);
+
+ its_data.cmd_write = its_data.cmd_base;
+ writeq(0, its_data.base + GITS_CWRITER);
+}
--
2.20.1
- Re: [kvm-unit-tests PATCH v2 03/16] arm/arm64: gic: Introduce setup_irq() helper, (continued)
- [kvm-unit-tests PATCH v2 04/16] arm/arm64: gicv3: Add some re-distributor defines, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 05/16] arm/arm64: ITS: Introspection tests, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 06/16] arm/arm64: ITS: Test BASER, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 07/16] arm/arm64: ITS: Set the LPI config and pending tables, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 08/16] arm/arm64: ITS: Init the command queue,
Eric Auger <=
- [kvm-unit-tests PATCH v2 09/16] arm/arm64: ITS: Enable/Disable LPIs at re-distributor level, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 10/16] arm/arm64: ITS: its_enable_defaults, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 11/16] arm/arm64: ITS: Device and collection Initialization, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 12/16] arm/arm64: ITS: commands, Eric Auger, 2020/01/10
- [kvm-unit-tests PATCH v2 13/16] arm/arm64: ITS: INT functional tests, Eric Auger, 2020/01/10