xref: /kvm-unit-tests/arm/gic.c (revision 0c03f4b160e8a9ffe8d8b61a7ec6f043135ca1cb)
1ac4a67b6SAndrew Jones /*
2ac4a67b6SAndrew Jones  * GIC tests
3ac4a67b6SAndrew Jones  *
4ac4a67b6SAndrew Jones  * GICv2
5ac4a67b6SAndrew Jones  *   + test sending/receiving IPIs
678ad7e95SAndre Przywara  *   + MMIO access tests
72e2d471dSAndrew Jones  * GICv3
82e2d471dSAndrew Jones  *   + test sending/receiving IPIs
9ac4a67b6SAndrew Jones  *
10ac4a67b6SAndrew Jones  * Copyright (C) 2016, Red Hat Inc, Andrew Jones <drjones@redhat.com>
11ac4a67b6SAndrew Jones  *
12ac4a67b6SAndrew Jones  * This work is licensed under the terms of the GNU LGPL, version 2.
13ac4a67b6SAndrew Jones  */
14ac4a67b6SAndrew Jones #include <libcflat.h>
15de582149SEric Auger #include <errata.h>
16ac4a67b6SAndrew Jones #include <asm/setup.h>
17ac4a67b6SAndrew Jones #include <asm/processor.h>
18ac4a67b6SAndrew Jones #include <asm/delay.h>
19ac4a67b6SAndrew Jones #include <asm/gic.h>
20ba74b106SEric Auger #include <asm/gic-v3-its.h>
21ac4a67b6SAndrew Jones #include <asm/smp.h>
22ac4a67b6SAndrew Jones #include <asm/barrier.h>
23ac4a67b6SAndrew Jones #include <asm/io.h>
24ac4a67b6SAndrew Jones 
25ca1b7a7bSAndrew Jones #define IPI_SENDER	1
26ca1b7a7bSAndrew Jones #define IPI_IRQ		1
27ca1b7a7bSAndrew Jones 
282e2d471dSAndrew Jones struct gic {
292e2d471dSAndrew Jones 	struct {
302e2d471dSAndrew Jones 		void (*send_self)(void);
312e2d471dSAndrew Jones 		void (*send_broadcast)(void);
322e2d471dSAndrew Jones 	} ipi;
332e2d471dSAndrew Jones };
342e2d471dSAndrew Jones 
352e2d471dSAndrew Jones static struct gic *gic;
36ac4a67b6SAndrew Jones static int acked[NR_CPUS], spurious[NR_CPUS];
37ca1b7a7bSAndrew Jones static int bad_sender[NR_CPUS], bad_irq[NR_CPUS];
38ac4a67b6SAndrew Jones static cpumask_t ready;
39ac4a67b6SAndrew Jones 
40ac4a67b6SAndrew Jones static void nr_cpu_check(int nr)
41ac4a67b6SAndrew Jones {
42ac4a67b6SAndrew Jones 	if (nr_cpus < nr)
43ac4a67b6SAndrew Jones 		report_abort("At least %d cpus required", nr);
44ac4a67b6SAndrew Jones }
45ac4a67b6SAndrew Jones 
46ac4a67b6SAndrew Jones static void wait_on_ready(void)
47ac4a67b6SAndrew Jones {
48ac4a67b6SAndrew Jones 	cpumask_set_cpu(smp_processor_id(), &ready);
49ac4a67b6SAndrew Jones 	while (!cpumask_full(&ready))
50ac4a67b6SAndrew Jones 		cpu_relax();
51ac4a67b6SAndrew Jones }
52ac4a67b6SAndrew Jones 
53ca1b7a7bSAndrew Jones static void stats_reset(void)
54ca1b7a7bSAndrew Jones {
55ca1b7a7bSAndrew Jones 	int i;
56ca1b7a7bSAndrew Jones 
57ca1b7a7bSAndrew Jones 	for (i = 0; i < nr_cpus; ++i) {
58ca1b7a7bSAndrew Jones 		acked[i] = 0;
59ca1b7a7bSAndrew Jones 		bad_sender[i] = -1;
60ca1b7a7bSAndrew Jones 		bad_irq[i] = -1;
61ca1b7a7bSAndrew Jones 	}
62ca1b7a7bSAndrew Jones 	smp_wmb();
63ca1b7a7bSAndrew Jones }
64ca1b7a7bSAndrew Jones 
6596edb026SAndre Przywara static void check_acked(const char *testname, cpumask_t *mask)
66ac4a67b6SAndrew Jones {
67ac4a67b6SAndrew Jones 	int missing = 0, extra = 0, unexpected = 0;
68ac4a67b6SAndrew Jones 	int nr_pass, cpu, i;
69ca1b7a7bSAndrew Jones 	bool bad = false;
70ac4a67b6SAndrew Jones 
71ac4a67b6SAndrew Jones 	/* Wait up to 5s for all interrupts to be delivered */
72ac4a67b6SAndrew Jones 	for (i = 0; i < 50; ++i) {
73ac4a67b6SAndrew Jones 		mdelay(100);
74ac4a67b6SAndrew Jones 		nr_pass = 0;
75ac4a67b6SAndrew Jones 		for_each_present_cpu(cpu) {
76ac4a67b6SAndrew Jones 			smp_rmb();
77ac4a67b6SAndrew Jones 			nr_pass += cpumask_test_cpu(cpu, mask) ?
78ac4a67b6SAndrew Jones 				acked[cpu] == 1 : acked[cpu] == 0;
79ca1b7a7bSAndrew Jones 
80ca1b7a7bSAndrew Jones 			if (bad_sender[cpu] != -1) {
81ca1b7a7bSAndrew Jones 				printf("cpu%d received IPI from wrong sender %d\n",
82ca1b7a7bSAndrew Jones 					cpu, bad_sender[cpu]);
83ca1b7a7bSAndrew Jones 				bad = true;
84ca1b7a7bSAndrew Jones 			}
85ca1b7a7bSAndrew Jones 
86ca1b7a7bSAndrew Jones 			if (bad_irq[cpu] != -1) {
87ca1b7a7bSAndrew Jones 				printf("cpu%d received wrong irq %d\n",
88ca1b7a7bSAndrew Jones 					cpu, bad_irq[cpu]);
89ca1b7a7bSAndrew Jones 				bad = true;
90ca1b7a7bSAndrew Jones 			}
91ac4a67b6SAndrew Jones 		}
92ac4a67b6SAndrew Jones 		if (nr_pass == nr_cpus) {
93a299895bSThomas Huth 			report(!bad, "%s", testname);
9496edb026SAndre Przywara 			if (i)
9596edb026SAndre Przywara 				report_info("took more than %d ms", i * 100);
96ac4a67b6SAndrew Jones 			return;
97ac4a67b6SAndrew Jones 		}
98ac4a67b6SAndrew Jones 	}
99ac4a67b6SAndrew Jones 
100ac4a67b6SAndrew Jones 	for_each_present_cpu(cpu) {
101ac4a67b6SAndrew Jones 		if (cpumask_test_cpu(cpu, mask)) {
102ac4a67b6SAndrew Jones 			if (!acked[cpu])
103ac4a67b6SAndrew Jones 				++missing;
104ac4a67b6SAndrew Jones 			else if (acked[cpu] > 1)
105ac4a67b6SAndrew Jones 				++extra;
106ac4a67b6SAndrew Jones 		} else {
107ac4a67b6SAndrew Jones 			if (acked[cpu])
108ac4a67b6SAndrew Jones 				++unexpected;
109ac4a67b6SAndrew Jones 		}
110ac4a67b6SAndrew Jones 	}
111ac4a67b6SAndrew Jones 
112a299895bSThomas Huth 	report(false, "%s", testname);
11396edb026SAndre Przywara 	report_info("Timed-out (5s). ACKS: missing=%d extra=%d unexpected=%d",
11496edb026SAndre Przywara 		    missing, extra, unexpected);
115ac4a67b6SAndrew Jones }
116ac4a67b6SAndrew Jones 
117ac4a67b6SAndrew Jones static void check_spurious(void)
118ac4a67b6SAndrew Jones {
119ac4a67b6SAndrew Jones 	int cpu;
120ac4a67b6SAndrew Jones 
121ac4a67b6SAndrew Jones 	smp_rmb();
122ac4a67b6SAndrew Jones 	for_each_present_cpu(cpu) {
123ac4a67b6SAndrew Jones 		if (spurious[cpu])
124ac4a67b6SAndrew Jones 			report_info("WARN: cpu%d got %d spurious interrupts",
125ac4a67b6SAndrew Jones 				cpu, spurious[cpu]);
126ac4a67b6SAndrew Jones 	}
127ac4a67b6SAndrew Jones }
128ac4a67b6SAndrew Jones 
129ca1b7a7bSAndrew Jones static void check_ipi_sender(u32 irqstat)
130ca1b7a7bSAndrew Jones {
131ca1b7a7bSAndrew Jones 	if (gic_version() == 2) {
132ca1b7a7bSAndrew Jones 		int src = (irqstat >> 10) & 7;
133ca1b7a7bSAndrew Jones 
134ca1b7a7bSAndrew Jones 		if (src != IPI_SENDER)
135ca1b7a7bSAndrew Jones 			bad_sender[smp_processor_id()] = src;
136ca1b7a7bSAndrew Jones 	}
137ca1b7a7bSAndrew Jones }
138ca1b7a7bSAndrew Jones 
139ca1b7a7bSAndrew Jones static void check_irqnr(u32 irqnr)
140ca1b7a7bSAndrew Jones {
141ca1b7a7bSAndrew Jones 	if (irqnr != IPI_IRQ)
142ca1b7a7bSAndrew Jones 		bad_irq[smp_processor_id()] = irqnr;
143ca1b7a7bSAndrew Jones }
144ca1b7a7bSAndrew Jones 
145ac4a67b6SAndrew Jones static void ipi_handler(struct pt_regs *regs __unused)
146ac4a67b6SAndrew Jones {
1472e2d471dSAndrew Jones 	u32 irqstat = gic_read_iar();
1482e2d471dSAndrew Jones 	u32 irqnr = gic_iar_irqnr(irqstat);
149ac4a67b6SAndrew Jones 
150ac4a67b6SAndrew Jones 	if (irqnr != GICC_INT_SPURIOUS) {
1512e2d471dSAndrew Jones 		gic_write_eoir(irqstat);
152ca1b7a7bSAndrew Jones 		smp_rmb(); /* pairs with wmb in stats_reset */
153ac4a67b6SAndrew Jones 		++acked[smp_processor_id()];
154ca1b7a7bSAndrew Jones 		check_ipi_sender(irqstat);
155ca1b7a7bSAndrew Jones 		check_irqnr(irqnr);
156ac4a67b6SAndrew Jones 		smp_wmb(); /* pairs with rmb in check_acked */
157ac4a67b6SAndrew Jones 	} else {
158ac4a67b6SAndrew Jones 		++spurious[smp_processor_id()];
159ac4a67b6SAndrew Jones 		smp_wmb();
160ac4a67b6SAndrew Jones 	}
161ac4a67b6SAndrew Jones }
162ac4a67b6SAndrew Jones 
1630ef02cd6SEric Auger static void setup_irq(irq_handler_fn handler)
1640ef02cd6SEric Auger {
1650ef02cd6SEric Auger 	gic_enable_defaults();
1660ef02cd6SEric Auger #ifdef __arm__
1670ef02cd6SEric Auger 	install_exception_handler(EXCPTN_IRQ, handler);
1680ef02cd6SEric Auger #else
1690ef02cd6SEric Auger 	install_irq_handler(EL1H_IRQ, handler);
1700ef02cd6SEric Auger #endif
1710ef02cd6SEric Auger 	local_irq_enable();
1720ef02cd6SEric Auger }
1730ef02cd6SEric Auger 
1740ef02cd6SEric Auger #if defined(__aarch64__)
1750ef02cd6SEric Auger struct its_event {
1760ef02cd6SEric Auger 	int cpu_id;
1770ef02cd6SEric Auger 	int lpi_id;
1780ef02cd6SEric Auger };
1790ef02cd6SEric Auger 
1800ef02cd6SEric Auger struct its_stats {
1810ef02cd6SEric Auger 	struct its_event expected;
1820ef02cd6SEric Auger 	struct its_event observed;
1830ef02cd6SEric Auger };
1840ef02cd6SEric Auger 
1850ef02cd6SEric Auger static struct its_stats lpi_stats;
1860ef02cd6SEric Auger 
1870ef02cd6SEric Auger static void lpi_handler(struct pt_regs *regs __unused)
1880ef02cd6SEric Auger {
1890ef02cd6SEric Auger 	u32 irqstat = gic_read_iar();
1900ef02cd6SEric Auger 	int irqnr = gic_iar_irqnr(irqstat);
1910ef02cd6SEric Auger 
1920ef02cd6SEric Auger 	gic_write_eoir(irqstat);
1930ef02cd6SEric Auger 	assert(irqnr >= 8192);
1940ef02cd6SEric Auger 	smp_rmb(); /* pairs with wmb in lpi_stats_expect */
1950ef02cd6SEric Auger 	lpi_stats.observed.cpu_id = smp_processor_id();
1960ef02cd6SEric Auger 	lpi_stats.observed.lpi_id = irqnr;
197de582149SEric Auger 	acked[lpi_stats.observed.cpu_id]++;
1980ef02cd6SEric Auger 	smp_wmb(); /* pairs with rmb in check_lpi_stats */
1990ef02cd6SEric Auger }
2000ef02cd6SEric Auger 
2010ef02cd6SEric Auger static void lpi_stats_expect(int exp_cpu_id, int exp_lpi_id)
2020ef02cd6SEric Auger {
2030ef02cd6SEric Auger 	lpi_stats.expected.cpu_id = exp_cpu_id;
2040ef02cd6SEric Auger 	lpi_stats.expected.lpi_id = exp_lpi_id;
2050ef02cd6SEric Auger 	lpi_stats.observed.cpu_id = -1;
2060ef02cd6SEric Auger 	lpi_stats.observed.lpi_id = -1;
2070ef02cd6SEric Auger 	smp_wmb(); /* pairs with rmb in handler */
2080ef02cd6SEric Auger }
2090ef02cd6SEric Auger 
2100ef02cd6SEric Auger static void check_lpi_stats(const char *msg)
2110ef02cd6SEric Auger {
2120ef02cd6SEric Auger 	int i;
2130ef02cd6SEric Auger 
2140ef02cd6SEric Auger 	for (i = 0; i < 50; i++) {
2150ef02cd6SEric Auger 		mdelay(100);
2160ef02cd6SEric Auger 		smp_rmb(); /* pairs with wmb in lpi_handler */
2170ef02cd6SEric Auger 		if (lpi_stats.observed.cpu_id == lpi_stats.expected.cpu_id &&
2180ef02cd6SEric Auger 		    lpi_stats.observed.lpi_id == lpi_stats.expected.lpi_id) {
2190ef02cd6SEric Auger 			report(true, "%s", msg);
2200ef02cd6SEric Auger 			return;
2210ef02cd6SEric Auger 		}
2220ef02cd6SEric Auger 	}
2230ef02cd6SEric Auger 
2240ef02cd6SEric Auger 	if (lpi_stats.observed.cpu_id == -1 && lpi_stats.observed.lpi_id == -1) {
2250ef02cd6SEric Auger 		report_info("No LPI received whereas (cpuid=%d, intid=%d) "
2260ef02cd6SEric Auger 			    "was expected", lpi_stats.expected.cpu_id,
2270ef02cd6SEric Auger 			    lpi_stats.expected.lpi_id);
2280ef02cd6SEric Auger 	} else {
2290ef02cd6SEric Auger 		report_info("Unexpected LPI (cpuid=%d, intid=%d)",
2300ef02cd6SEric Auger 			    lpi_stats.observed.cpu_id,
2310ef02cd6SEric Auger 			    lpi_stats.observed.lpi_id);
2320ef02cd6SEric Auger 	}
2330ef02cd6SEric Auger 	report(false, "%s", msg);
2340ef02cd6SEric Auger }
2350ef02cd6SEric Auger 
2360ef02cd6SEric Auger static void secondary_lpi_test(void)
2370ef02cd6SEric Auger {
2380ef02cd6SEric Auger 	setup_irq(lpi_handler);
2390ef02cd6SEric Auger 	cpumask_set_cpu(smp_processor_id(), &ready);
2400ef02cd6SEric Auger 	while (1)
2410ef02cd6SEric Auger 		wfi();
2420ef02cd6SEric Auger }
243de582149SEric Auger 
244de582149SEric Auger static void check_lpi_hits(int *expected, const char *msg)
245de582149SEric Auger {
246de582149SEric Auger 	bool pass = true;
247de582149SEric Auger 	int i;
248de582149SEric Auger 
249de582149SEric Auger 	for_each_present_cpu(i) {
250de582149SEric Auger 		if (acked[i] != expected[i]) {
251de582149SEric Auger 			report_info("expected %d LPIs on PE #%d, %d observed",
252de582149SEric Auger 				    expected[i], i, acked[i]);
253de582149SEric Auger 			pass = false;
254de582149SEric Auger 			break;
255de582149SEric Auger 		}
256de582149SEric Auger 	}
257de582149SEric Auger 	report(pass, "%s", msg);
258de582149SEric Auger }
2590ef02cd6SEric Auger #endif
2600ef02cd6SEric Auger 
2612e2d471dSAndrew Jones static void gicv2_ipi_send_self(void)
2622e2d471dSAndrew Jones {
263ca1b7a7bSAndrew Jones 	writel(2 << 24 | IPI_IRQ, gicv2_dist_base() + GICD_SGIR);
2642e2d471dSAndrew Jones }
2652e2d471dSAndrew Jones 
2662e2d471dSAndrew Jones static void gicv2_ipi_send_broadcast(void)
2672e2d471dSAndrew Jones {
268ca1b7a7bSAndrew Jones 	writel(1 << 24 | IPI_IRQ, gicv2_dist_base() + GICD_SGIR);
2692e2d471dSAndrew Jones }
2702e2d471dSAndrew Jones 
2712e2d471dSAndrew Jones static void gicv3_ipi_send_self(void)
2722e2d471dSAndrew Jones {
273ca1b7a7bSAndrew Jones 	gic_ipi_send_single(IPI_IRQ, smp_processor_id());
2742e2d471dSAndrew Jones }
2752e2d471dSAndrew Jones 
2762e2d471dSAndrew Jones static void gicv3_ipi_send_broadcast(void)
2772e2d471dSAndrew Jones {
278*0c03f4b1SAlexandru Elisei 	/*
279*0c03f4b1SAlexandru Elisei 	 * Ensure stores to Normal memory are visible to other CPUs before
280*0c03f4b1SAlexandru Elisei 	 * sending the IPI
281*0c03f4b1SAlexandru Elisei 	 */
282*0c03f4b1SAlexandru Elisei 	wmb();
283ca1b7a7bSAndrew Jones 	gicv3_write_sgi1r(1ULL << 40 | IPI_IRQ << 24);
2842e2d471dSAndrew Jones 	isb();
2852e2d471dSAndrew Jones }
2862e2d471dSAndrew Jones 
287ac4a67b6SAndrew Jones static void ipi_test_self(void)
288ac4a67b6SAndrew Jones {
289ac4a67b6SAndrew Jones 	cpumask_t mask;
290ac4a67b6SAndrew Jones 
291ac4a67b6SAndrew Jones 	report_prefix_push("self");
292ca1b7a7bSAndrew Jones 	stats_reset();
293ac4a67b6SAndrew Jones 	cpumask_clear(&mask);
294ca1b7a7bSAndrew Jones 	cpumask_set_cpu(smp_processor_id(), &mask);
2952e2d471dSAndrew Jones 	gic->ipi.send_self();
29696edb026SAndre Przywara 	check_acked("IPI: self", &mask);
297ac4a67b6SAndrew Jones 	report_prefix_pop();
298ac4a67b6SAndrew Jones }
299ac4a67b6SAndrew Jones 
300ac4a67b6SAndrew Jones static void ipi_test_smp(void)
301ac4a67b6SAndrew Jones {
302ac4a67b6SAndrew Jones 	cpumask_t mask;
3032e2d471dSAndrew Jones 	int i;
304ac4a67b6SAndrew Jones 
305ac4a67b6SAndrew Jones 	report_prefix_push("target-list");
306ca1b7a7bSAndrew Jones 	stats_reset();
3072e2d471dSAndrew Jones 	cpumask_copy(&mask, &cpu_present_mask);
308ca1b7a7bSAndrew Jones 	for (i = smp_processor_id() & 1; i < nr_cpus; i += 2)
3092e2d471dSAndrew Jones 		cpumask_clear_cpu(i, &mask);
310ca1b7a7bSAndrew Jones 	gic_ipi_send_mask(IPI_IRQ, &mask);
31196edb026SAndre Przywara 	check_acked("IPI: directed", &mask);
312ac4a67b6SAndrew Jones 	report_prefix_pop();
313ac4a67b6SAndrew Jones 
314ac4a67b6SAndrew Jones 	report_prefix_push("broadcast");
315ca1b7a7bSAndrew Jones 	stats_reset();
316ac4a67b6SAndrew Jones 	cpumask_copy(&mask, &cpu_present_mask);
317ca1b7a7bSAndrew Jones 	cpumask_clear_cpu(smp_processor_id(), &mask);
3182e2d471dSAndrew Jones 	gic->ipi.send_broadcast();
31996edb026SAndre Przywara 	check_acked("IPI: broadcast", &mask);
320ac4a67b6SAndrew Jones 	report_prefix_pop();
321ac4a67b6SAndrew Jones }
322ac4a67b6SAndrew Jones 
323ca1b7a7bSAndrew Jones static void ipi_send(void)
324ca1b7a7bSAndrew Jones {
32525f66327SEric Auger 	setup_irq(ipi_handler);
326ca1b7a7bSAndrew Jones 	wait_on_ready();
327ca1b7a7bSAndrew Jones 	ipi_test_self();
328ca1b7a7bSAndrew Jones 	ipi_test_smp();
329ca1b7a7bSAndrew Jones 	check_spurious();
330ca1b7a7bSAndrew Jones 	exit(report_summary());
331ca1b7a7bSAndrew Jones }
332ca1b7a7bSAndrew Jones 
333ac4a67b6SAndrew Jones static void ipi_recv(void)
334ac4a67b6SAndrew Jones {
33525f66327SEric Auger 	setup_irq(ipi_handler);
336ac4a67b6SAndrew Jones 	cpumask_set_cpu(smp_processor_id(), &ready);
337ac4a67b6SAndrew Jones 	while (1)
338ac4a67b6SAndrew Jones 		wfi();
339ac4a67b6SAndrew Jones }
340ac4a67b6SAndrew Jones 
34100b34f56SAndrew Jones static void ipi_test(void *data __unused)
342bfd500b4SAndrew Jones {
343bfd500b4SAndrew Jones 	if (smp_processor_id() == IPI_SENDER)
344bfd500b4SAndrew Jones 		ipi_send();
345bfd500b4SAndrew Jones 	else
346bfd500b4SAndrew Jones 		ipi_recv();
347bfd500b4SAndrew Jones }
348bfd500b4SAndrew Jones 
3492e2d471dSAndrew Jones static struct gic gicv2 = {
3502e2d471dSAndrew Jones 	.ipi = {
3512e2d471dSAndrew Jones 		.send_self = gicv2_ipi_send_self,
3522e2d471dSAndrew Jones 		.send_broadcast = gicv2_ipi_send_broadcast,
3532e2d471dSAndrew Jones 	},
3542e2d471dSAndrew Jones };
3552e2d471dSAndrew Jones 
3562e2d471dSAndrew Jones static struct gic gicv3 = {
3572e2d471dSAndrew Jones 	.ipi = {
3582e2d471dSAndrew Jones 		.send_self = gicv3_ipi_send_self,
3592e2d471dSAndrew Jones 		.send_broadcast = gicv3_ipi_send_broadcast,
3602e2d471dSAndrew Jones 	},
3612e2d471dSAndrew Jones };
3622e2d471dSAndrew Jones 
363c152d8bcSChristoffer Dall static void ipi_clear_active_handler(struct pt_regs *regs __unused)
364c152d8bcSChristoffer Dall {
365c152d8bcSChristoffer Dall 	u32 irqstat = gic_read_iar();
366c152d8bcSChristoffer Dall 	u32 irqnr = gic_iar_irqnr(irqstat);
367c152d8bcSChristoffer Dall 
368c152d8bcSChristoffer Dall 	if (irqnr != GICC_INT_SPURIOUS) {
369c152d8bcSChristoffer Dall 		void *base;
370c152d8bcSChristoffer Dall 		u32 val = 1 << IPI_IRQ;
371c152d8bcSChristoffer Dall 
372c152d8bcSChristoffer Dall 		if (gic_version() == 2)
373c152d8bcSChristoffer Dall 			base = gicv2_dist_base();
374c152d8bcSChristoffer Dall 		else
3756d4d7c4bSAndrew Jones 			base = gicv3_sgi_base();
376c152d8bcSChristoffer Dall 
377c152d8bcSChristoffer Dall 		writel(val, base + GICD_ICACTIVER);
378c152d8bcSChristoffer Dall 
379c152d8bcSChristoffer Dall 		smp_rmb(); /* pairs with wmb in stats_reset */
380c152d8bcSChristoffer Dall 		++acked[smp_processor_id()];
381c152d8bcSChristoffer Dall 		check_irqnr(irqnr);
382c152d8bcSChristoffer Dall 		smp_wmb(); /* pairs with rmb in check_acked */
383c152d8bcSChristoffer Dall 	} else {
384c152d8bcSChristoffer Dall 		++spurious[smp_processor_id()];
385c152d8bcSChristoffer Dall 		smp_wmb();
386c152d8bcSChristoffer Dall 	}
387c152d8bcSChristoffer Dall }
388c152d8bcSChristoffer Dall 
389c152d8bcSChristoffer Dall static void run_active_clear_test(void)
390c152d8bcSChristoffer Dall {
391c152d8bcSChristoffer Dall 	report_prefix_push("active");
39225f66327SEric Auger 	setup_irq(ipi_clear_active_handler);
393c152d8bcSChristoffer Dall 	ipi_test_self();
394c152d8bcSChristoffer Dall 	report_prefix_pop();
395c152d8bcSChristoffer Dall }
396c152d8bcSChristoffer Dall 
39778ad7e95SAndre Przywara static bool test_ro_pattern_32(void *address, u32 pattern, u32 orig)
39878ad7e95SAndre Przywara {
39978ad7e95SAndre Przywara 	u32 reg;
40078ad7e95SAndre Przywara 
40178ad7e95SAndre Przywara 	writel(pattern, address);
40278ad7e95SAndre Przywara 	reg = readl(address);
40378ad7e95SAndre Przywara 
40478ad7e95SAndre Przywara 	if (reg != orig)
40578ad7e95SAndre Przywara 		writel(orig, address);
40678ad7e95SAndre Przywara 
40778ad7e95SAndre Przywara 	return reg == orig;
40878ad7e95SAndre Przywara }
40978ad7e95SAndre Przywara 
41078ad7e95SAndre Przywara static bool test_readonly_32(void *address, bool razwi)
41178ad7e95SAndre Przywara {
41278ad7e95SAndre Przywara 	u32 orig, pattern;
41378ad7e95SAndre Przywara 
41478ad7e95SAndre Przywara 	orig = readl(address);
41578ad7e95SAndre Przywara 	if (razwi && orig)
41678ad7e95SAndre Przywara 		return false;
41778ad7e95SAndre Przywara 
41878ad7e95SAndre Przywara 	pattern = 0xffffffff;
41978ad7e95SAndre Przywara 	if (orig != pattern) {
42078ad7e95SAndre Przywara 		if (!test_ro_pattern_32(address, pattern, orig))
42178ad7e95SAndre Przywara 			return false;
42278ad7e95SAndre Przywara 	}
42378ad7e95SAndre Przywara 
42478ad7e95SAndre Przywara 	pattern = 0xa5a55a5a;
42578ad7e95SAndre Przywara 	if (orig != pattern) {
42678ad7e95SAndre Przywara 		if (!test_ro_pattern_32(address, pattern, orig))
42778ad7e95SAndre Przywara 			return false;
42878ad7e95SAndre Przywara 	}
42978ad7e95SAndre Przywara 
43078ad7e95SAndre Przywara 	pattern = 0;
43178ad7e95SAndre Przywara 	if (orig != pattern) {
43278ad7e95SAndre Przywara 		if (!test_ro_pattern_32(address, pattern, orig))
43378ad7e95SAndre Przywara 			return false;
43478ad7e95SAndre Przywara 	}
43578ad7e95SAndre Przywara 
43678ad7e95SAndre Przywara 	return true;
43778ad7e95SAndre Przywara }
43878ad7e95SAndre Przywara 
43978ad7e95SAndre Przywara static void test_typer_v2(uint32_t reg)
44078ad7e95SAndre Przywara {
44178ad7e95SAndre Przywara 	int nr_gic_cpus = ((reg >> 5) & 0x7) + 1;
44278ad7e95SAndre Przywara 
4438e0a4f41SAndre Przywara 	report_info("nr_cpus=%d", nr_cpus);
444a299895bSThomas Huth 	report(nr_cpus == nr_gic_cpus, "all CPUs have interrupts");
44578ad7e95SAndre Przywara }
44678ad7e95SAndre Przywara 
447ff31a1c4SAndre Przywara #define BYTE(reg32, byte) (((reg32) >> ((byte) * 8)) & 0xff)
448ff31a1c4SAndre Przywara #define REPLACE_BYTE(reg32, byte, new) (((reg32) & ~(0xff << ((byte) * 8))) |\
449ff31a1c4SAndre Przywara 					((new) << ((byte) * 8)))
450ff31a1c4SAndre Przywara 
451ff31a1c4SAndre Przywara /*
452ff31a1c4SAndre Przywara  * Some registers are byte accessible, do a byte-wide read and write of known
453ff31a1c4SAndre Przywara  * content to check for this.
454ff31a1c4SAndre Przywara  * Apply a @mask to cater for special register properties.
455ff31a1c4SAndre Przywara  * @pattern contains the value already in the register.
456ff31a1c4SAndre Przywara  */
457ff31a1c4SAndre Przywara static void test_byte_access(void *base_addr, u32 pattern, u32 mask)
458ff31a1c4SAndre Przywara {
459ff31a1c4SAndre Przywara 	u32 reg = readb(base_addr + 1);
4608e0a4f41SAndre Przywara 	bool res;
461ff31a1c4SAndre Przywara 
4628e0a4f41SAndre Przywara 	res = (reg == (BYTE(pattern, 1) & (mask >> 8)));
463a299895bSThomas Huth 	report(res, "byte reads successful");
4648e0a4f41SAndre Przywara 	if (!res)
46546ca10f4SAlexandru Elisei 		report_info("byte 1 of 0x%08"PRIx32" => 0x%02"PRIx32, pattern & mask, reg);
466ff31a1c4SAndre Przywara 
467ff31a1c4SAndre Przywara 	pattern = REPLACE_BYTE(pattern, 2, 0x1f);
468ff31a1c4SAndre Przywara 	writeb(BYTE(pattern, 2), base_addr + 2);
469ff31a1c4SAndre Przywara 	reg = readl(base_addr);
4708e0a4f41SAndre Przywara 	res = (reg == (pattern & mask));
471a299895bSThomas Huth 	report(res, "byte writes successful");
4728e0a4f41SAndre Przywara 	if (!res)
47346ca10f4SAlexandru Elisei 		report_info("writing 0x%02"PRIx32" into bytes 2 => 0x%08"PRIx32,
4748e0a4f41SAndre Przywara 			    BYTE(pattern, 2), reg);
475ff31a1c4SAndre Przywara }
476ff31a1c4SAndre Przywara 
477ff31a1c4SAndre Przywara static void test_priorities(int nr_irqs, void *priptr)
478ff31a1c4SAndre Przywara {
479ff31a1c4SAndre Przywara 	u32 orig_prio, reg, pri_bits;
480ff31a1c4SAndre Przywara 	u32 pri_mask, pattern;
481ff31a1c4SAndre Przywara 	void *first_spi = priptr + GIC_FIRST_SPI;
482ff31a1c4SAndre Przywara 
483ff31a1c4SAndre Przywara 	orig_prio = readl(first_spi);
484ff31a1c4SAndre Przywara 	report_prefix_push("IPRIORITYR");
485ff31a1c4SAndre Przywara 
486ff31a1c4SAndre Przywara 	/*
487ff31a1c4SAndre Przywara 	 * Determine implemented number of priority bits by writing all 1's
488ff31a1c4SAndre Przywara 	 * and checking the number of cleared bits in the value read back.
489ff31a1c4SAndre Przywara 	 */
490ff31a1c4SAndre Przywara 	writel(0xffffffff, first_spi);
491ff31a1c4SAndre Przywara 	pri_mask = readl(first_spi);
492ff31a1c4SAndre Przywara 
493ff31a1c4SAndre Przywara 	reg = ~pri_mask;
494a299895bSThomas Huth 	report((((reg >> 16) == (reg & 0xffff)) &&
495a299895bSThomas Huth 	        ((reg & 0xff) == ((reg >> 8) & 0xff))),
496a299895bSThomas Huth 	       "consistent priority masking");
49746ca10f4SAlexandru Elisei 	report_info("priority mask is 0x%08"PRIx32, pri_mask);
498ff31a1c4SAndre Przywara 
499ff31a1c4SAndre Przywara 	reg = reg & 0xff;
500ff31a1c4SAndre Przywara 	for (pri_bits = 8; reg & 1; reg >>= 1, pri_bits--)
501ff31a1c4SAndre Przywara 		;
502a299895bSThomas Huth 	report(pri_bits >= 4, "implements at least 4 priority bits");
50346ca10f4SAlexandru Elisei 	report_info("%"PRIu32" priority bits implemented", pri_bits);
504ff31a1c4SAndre Przywara 
505ff31a1c4SAndre Przywara 	pattern = 0;
506ff31a1c4SAndre Przywara 	writel(pattern, first_spi);
507a299895bSThomas Huth 	report(readl(first_spi) == pattern, "clearing priorities");
508ff31a1c4SAndre Przywara 
509ff31a1c4SAndre Przywara 	/* setting all priorities to their max valus was tested above */
510ff31a1c4SAndre Przywara 
511a299895bSThomas Huth 	report(test_readonly_32(priptr + nr_irqs, true),
512a299895bSThomas Huth 	       "accesses beyond limit RAZ/WI");
513ff31a1c4SAndre Przywara 
514ff31a1c4SAndre Przywara 	writel(pattern, priptr + nr_irqs - 4);
515a299895bSThomas Huth 	report(readl(priptr + nr_irqs - 4) == (pattern & pri_mask),
516a299895bSThomas Huth 	       "accessing last SPIs");
517ff31a1c4SAndre Przywara 
518ff31a1c4SAndre Przywara 	pattern = 0xff7fbf3f;
519ff31a1c4SAndre Przywara 	writel(pattern, first_spi);
520a299895bSThomas Huth 	report(readl(first_spi) == (pattern & pri_mask),
521a299895bSThomas Huth 	       "priorities are preserved");
522ff31a1c4SAndre Przywara 
523ff31a1c4SAndre Przywara 	/* The PRIORITY registers are byte accessible. */
524ff31a1c4SAndre Przywara 	test_byte_access(first_spi, pattern, pri_mask);
525ff31a1c4SAndre Przywara 
526ff31a1c4SAndre Przywara 	report_prefix_pop();
527ff31a1c4SAndre Przywara 	writel(orig_prio, first_spi);
528ff31a1c4SAndre Przywara }
529ff31a1c4SAndre Przywara 
530fe572a5eSAndre Przywara /* GICD_ITARGETSR is only used by GICv2. */
531fe572a5eSAndre Przywara static void test_targets(int nr_irqs)
532fe572a5eSAndre Przywara {
533fe572a5eSAndre Przywara 	void *targetsptr = gicv2_dist_base() + GICD_ITARGETSR;
534fe572a5eSAndre Przywara 	u32 orig_targets;
535fe572a5eSAndre Przywara 	u32 cpu_mask;
536fe572a5eSAndre Przywara 	u32 pattern, reg;
537fe572a5eSAndre Przywara 
538fe572a5eSAndre Przywara 	orig_targets = readl(targetsptr + GIC_FIRST_SPI);
539fe572a5eSAndre Przywara 	report_prefix_push("ITARGETSR");
540fe572a5eSAndre Przywara 
541fe572a5eSAndre Przywara 	cpu_mask = (1 << nr_cpus) - 1;
542fe572a5eSAndre Przywara 	cpu_mask |= cpu_mask << 8;
543fe572a5eSAndre Przywara 	cpu_mask |= cpu_mask << 16;
544fe572a5eSAndre Przywara 
545fe572a5eSAndre Przywara 	/* Check that bits for non implemented CPUs are RAZ/WI. */
546fe572a5eSAndre Przywara 	if (nr_cpus < 8) {
547fe572a5eSAndre Przywara 		writel(0xffffffff, targetsptr + GIC_FIRST_SPI);
548a299895bSThomas Huth 		report(!(readl(targetsptr + GIC_FIRST_SPI) & ~cpu_mask),
549a299895bSThomas Huth 		       "bits for non-existent CPUs masked");
5508e0a4f41SAndre Przywara 		report_info("%d non-existent CPUs", 8 - nr_cpus);
551fe572a5eSAndre Przywara 	} else {
552fe572a5eSAndre Przywara 		report_skip("CPU masking (all CPUs implemented)");
553fe572a5eSAndre Przywara 	}
554fe572a5eSAndre Przywara 
555a299895bSThomas Huth 	report(test_readonly_32(targetsptr + nr_irqs, true),
556a299895bSThomas Huth 	       "accesses beyond limit RAZ/WI");
557fe572a5eSAndre Przywara 
558fe572a5eSAndre Przywara 	pattern = 0x0103020f;
559fe572a5eSAndre Przywara 	writel(pattern, targetsptr + GIC_FIRST_SPI);
560fe572a5eSAndre Przywara 	reg = readl(targetsptr + GIC_FIRST_SPI);
561a299895bSThomas Huth 	report(reg == (pattern & cpu_mask), "register content preserved");
5628e0a4f41SAndre Przywara 	if (reg != (pattern & cpu_mask))
56346ca10f4SAlexandru Elisei 		report_info("writing %08"PRIx32" reads back as %08"PRIx32,
5648e0a4f41SAndre Przywara 			    pattern & cpu_mask, reg);
565fe572a5eSAndre Przywara 
566fe572a5eSAndre Przywara 	/* The TARGETS registers are byte accessible. */
567fe572a5eSAndre Przywara 	test_byte_access(targetsptr + GIC_FIRST_SPI, pattern, cpu_mask);
568fe572a5eSAndre Przywara 
569fe572a5eSAndre Przywara 	writel(orig_targets, targetsptr + GIC_FIRST_SPI);
570da5b8576SAndre Przywara 
571da5b8576SAndre Przywara 	report_prefix_pop();
572fe572a5eSAndre Przywara }
573fe572a5eSAndre Przywara 
57478ad7e95SAndre Przywara static void gic_test_mmio(void)
57578ad7e95SAndre Przywara {
57678ad7e95SAndre Przywara 	u32 reg;
57778ad7e95SAndre Przywara 	int nr_irqs;
57878ad7e95SAndre Przywara 	void *gic_dist_base, *idreg;
57978ad7e95SAndre Przywara 
58078ad7e95SAndre Przywara 	switch(gic_version()) {
58178ad7e95SAndre Przywara 	case 0x2:
58278ad7e95SAndre Przywara 		gic_dist_base = gicv2_dist_base();
58378ad7e95SAndre Przywara 		idreg = gic_dist_base + GICD_ICPIDR2;
58478ad7e95SAndre Przywara 		break;
58578ad7e95SAndre Przywara 	case 0x3:
58678ad7e95SAndre Przywara 		report_abort("GICv3 MMIO tests NYI");
58778ad7e95SAndre Przywara 	default:
58878ad7e95SAndre Przywara 		report_abort("GIC version %d not supported", gic_version());
58978ad7e95SAndre Przywara 	}
59078ad7e95SAndre Przywara 
59178ad7e95SAndre Przywara 	reg = readl(gic_dist_base + GICD_TYPER);
59278ad7e95SAndre Przywara 	nr_irqs = GICD_TYPER_IRQS(reg);
59378ad7e95SAndre Przywara 	report_info("number of implemented SPIs: %d", nr_irqs - GIC_FIRST_SPI);
59478ad7e95SAndre Przywara 
59578ad7e95SAndre Przywara 	test_typer_v2(reg);
59678ad7e95SAndre Przywara 
59746ca10f4SAlexandru Elisei 	report_info("IIDR: 0x%08"PRIx32, readl(gic_dist_base + GICD_IIDR));
59878ad7e95SAndre Przywara 
599a299895bSThomas Huth 	report(test_readonly_32(gic_dist_base + GICD_TYPER, false),
600a299895bSThomas Huth                "GICD_TYPER is read-only");
601a299895bSThomas Huth 	report(test_readonly_32(gic_dist_base + GICD_IIDR, false),
602a299895bSThomas Huth                "GICD_IIDR is read-only");
60378ad7e95SAndre Przywara 
60478ad7e95SAndre Przywara 	reg = readl(idreg);
605a299895bSThomas Huth 	report(test_readonly_32(idreg, false), "ICPIDR2 is read-only");
60646ca10f4SAlexandru Elisei 	report_info("value of ICPIDR2: 0x%08"PRIx32, reg);
607ff31a1c4SAndre Przywara 
608ff31a1c4SAndre Przywara 	test_priorities(nr_irqs, gic_dist_base + GICD_IPRIORITYR);
609fe572a5eSAndre Przywara 
610fe572a5eSAndre Przywara 	if (gic_version() == 2)
611fe572a5eSAndre Przywara 		test_targets(nr_irqs);
61278ad7e95SAndre Przywara }
61378ad7e95SAndre Przywara 
614ba74b106SEric Auger #if defined(__arm__)
615ba74b106SEric Auger 
616ba74b106SEric Auger static void test_its_introspection(void) {}
6170ef02cd6SEric Auger static void test_its_trigger(void) {}
61864260a5fSEric Auger static void test_its_migration(void) {}
619de582149SEric Auger static void test_its_pending_migration(void) {}
620de582149SEric Auger static void test_migrate_unmapped_collection(void) {}
621ba74b106SEric Auger 
622ba74b106SEric Auger #else /* __aarch64__ */
623ba74b106SEric Auger 
624ba74b106SEric Auger static void test_its_introspection(void)
625ba74b106SEric Auger {
626ba74b106SEric Auger 	struct its_baser *dev_baser = &its_data.device_baser;
627ba74b106SEric Auger 	struct its_baser *coll_baser = &its_data.coll_baser;
628ba74b106SEric Auger 	struct its_typer *typer = &its_data.typer;
629ba74b106SEric Auger 
630ba74b106SEric Auger 	if (!gicv3_its_base()) {
631ba74b106SEric Auger 		report_skip("No ITS, skip ...");
632ba74b106SEric Auger 		return;
633ba74b106SEric Auger 	}
634ba74b106SEric Auger 
635ba74b106SEric Auger 	/* IIDR */
636ba74b106SEric Auger 	report(test_readonly_32(gicv3_its_base() + GITS_IIDR, false),
637ba74b106SEric Auger 	       "GITS_IIDR is read-only"),
638ba74b106SEric Auger 
639ba74b106SEric Auger 	/* TYPER */
640ba74b106SEric Auger 	report(test_readonly_32(gicv3_its_base() + GITS_TYPER, false),
641ba74b106SEric Auger 	       "GITS_TYPER is read-only");
642ba74b106SEric Auger 
643ba74b106SEric Auger 	report(typer->phys_lpi, "ITS supports physical LPIs");
644ba74b106SEric Auger 	report_info("vLPI support: %s", typer->virt_lpi ? "yes" : "no");
645ba74b106SEric Auger 	report_info("ITT entry size = 0x%x", typer->ite_size);
646ba74b106SEric Auger 	report_info("Bit Count: EventID=%d DeviceId=%d CollId=%d",
647ba74b106SEric Auger 		    typer->eventid_bits, typer->deviceid_bits,
648ba74b106SEric Auger 		    typer->collid_bits);
649ba74b106SEric Auger 	report(typer->eventid_bits && typer->deviceid_bits &&
650ba74b106SEric Auger 	       typer->collid_bits, "ID spaces");
651ba74b106SEric Auger 	report_info("Target address format %s",
652ba74b106SEric Auger 			typer->pta ? "Redist base address" : "PE #");
653ba74b106SEric Auger 
654ba74b106SEric Auger 	report(dev_baser && coll_baser, "detect device and collection BASER");
655ba74b106SEric Auger 	report_info("device table entry_size = 0x%x", dev_baser->esz);
656ba74b106SEric Auger 	report_info("collection table entry_size = 0x%x", coll_baser->esz);
657ba74b106SEric Auger }
658ba74b106SEric Auger 
6590ef02cd6SEric Auger static int its_prerequisites(int nb_cpus)
6600ef02cd6SEric Auger {
6610ef02cd6SEric Auger 	int cpu;
6620ef02cd6SEric Auger 
6630ef02cd6SEric Auger 	if (!gicv3_its_base()) {
6640ef02cd6SEric Auger 		report_skip("No ITS, skip ...");
6650ef02cd6SEric Auger 		return -1;
6660ef02cd6SEric Auger 	}
6670ef02cd6SEric Auger 
6680ef02cd6SEric Auger 	if (nr_cpus < nb_cpus) {
6690ef02cd6SEric Auger 		report_skip("Test requires at least %d vcpus", nb_cpus);
6700ef02cd6SEric Auger 		return -1;
6710ef02cd6SEric Auger 	}
6720ef02cd6SEric Auger 
6730ef02cd6SEric Auger 	stats_reset();
6740ef02cd6SEric Auger 
6750ef02cd6SEric Auger 	setup_irq(lpi_handler);
6760ef02cd6SEric Auger 
6770ef02cd6SEric Auger 	for_each_present_cpu(cpu) {
6780ef02cd6SEric Auger 		if (cpu == 0)
6790ef02cd6SEric Auger 			continue;
6800ef02cd6SEric Auger 		smp_boot_secondary(cpu, secondary_lpi_test);
6810ef02cd6SEric Auger 	}
6820ef02cd6SEric Auger 	wait_on_ready();
6830ef02cd6SEric Auger 
6840ef02cd6SEric Auger 	its_enable_defaults();
6850ef02cd6SEric Auger 
6860ef02cd6SEric Auger 	return 0;
6870ef02cd6SEric Auger }
6880ef02cd6SEric Auger 
68964260a5fSEric Auger /*
69064260a5fSEric Auger  * Setup the configuration for those mappings:
69164260a5fSEric Auger  * dev_id=2 event=20 -> vcpu 3, intid=8195
69264260a5fSEric Auger  * dev_id=7 event=255 -> vcpu 2, intid=8196
69364260a5fSEric Auger  * LPIs ready to hit
69464260a5fSEric Auger  */
69564260a5fSEric Auger static int its_setup1(void)
6960ef02cd6SEric Auger {
6970ef02cd6SEric Auger 	struct its_collection *col3, *col2;
6980ef02cd6SEric Auger 	struct its_device *dev2, *dev7;
6990ef02cd6SEric Auger 
7000ef02cd6SEric Auger 	if (its_prerequisites(4))
70164260a5fSEric Auger 		return -1;
7020ef02cd6SEric Auger 
7030ef02cd6SEric Auger 	dev2 = its_create_device(2 /* dev id */, 8 /* nb_ites */);
7040ef02cd6SEric Auger 	dev7 = its_create_device(7 /* dev id */, 8 /* nb_ites */);
7050ef02cd6SEric Auger 
7060ef02cd6SEric Auger 	col3 = its_create_collection(3 /* col id */, 3/* target PE */);
7070ef02cd6SEric Auger 	col2 = its_create_collection(2 /* col id */, 2/* target PE */);
7080ef02cd6SEric Auger 
7090ef02cd6SEric Auger 	gicv3_lpi_set_config(8195, LPI_PROP_DEFAULT);
7100ef02cd6SEric Auger 	gicv3_lpi_set_config(8196, LPI_PROP_DEFAULT);
7110ef02cd6SEric Auger 
7120ef02cd6SEric Auger 	/*
7130ef02cd6SEric Auger 	 * dev=2, eventid=20  -> lpi= 8195, col=3
7140ef02cd6SEric Auger 	 * dev=7, eventid=255 -> lpi= 8196, col=2
7150ef02cd6SEric Auger 	 */
7160ef02cd6SEric Auger 	its_send_mapd(dev2, true);
7170ef02cd6SEric Auger 	its_send_mapd(dev7, true);
7180ef02cd6SEric Auger 
7190ef02cd6SEric Auger 	its_send_mapc(col3, true);
7200ef02cd6SEric Auger 	its_send_mapc(col2, true);
7210ef02cd6SEric Auger 
7220ef02cd6SEric Auger 	its_send_invall(col2);
7230ef02cd6SEric Auger 	its_send_invall(col3);
7240ef02cd6SEric Auger 
7250ef02cd6SEric Auger 	its_send_mapti(dev2, 8195 /* lpi id */, 20 /* event id */, col3);
7260ef02cd6SEric Auger 	its_send_mapti(dev7, 8196 /* lpi id */, 255 /* event id */, col2);
72764260a5fSEric Auger 	return 0;
72864260a5fSEric Auger }
72964260a5fSEric Auger 
73064260a5fSEric Auger static void test_its_trigger(void)
73164260a5fSEric Auger {
73264260a5fSEric Auger 	struct its_collection *col3;
73364260a5fSEric Auger 	struct its_device *dev2, *dev7;
73464260a5fSEric Auger 
73564260a5fSEric Auger 	if (its_setup1())
73664260a5fSEric Auger 		return;
73764260a5fSEric Auger 
73864260a5fSEric Auger 	col3 = its_get_collection(3);
73964260a5fSEric Auger 	dev2 = its_get_device(2);
74064260a5fSEric Auger 	dev7 = its_get_device(7);
74164260a5fSEric Auger 
74264260a5fSEric Auger 	report_prefix_push("int");
7430ef02cd6SEric Auger 
7440ef02cd6SEric Auger 	lpi_stats_expect(3, 8195);
7450ef02cd6SEric Auger 	its_send_int(dev2, 20);
7460ef02cd6SEric Auger 	check_lpi_stats("dev=2, eventid=20  -> lpi= 8195, col=3");
7470ef02cd6SEric Auger 
7480ef02cd6SEric Auger 	lpi_stats_expect(2, 8196);
7490ef02cd6SEric Auger 	its_send_int(dev7, 255);
7500ef02cd6SEric Auger 	check_lpi_stats("dev=7, eventid=255 -> lpi= 8196, col=2");
7510ef02cd6SEric Auger 
7520ef02cd6SEric Auger 	report_prefix_pop();
7530ef02cd6SEric Auger 
7540ef02cd6SEric Auger 	report_prefix_push("inv/invall");
7550ef02cd6SEric Auger 
7560ef02cd6SEric Auger 	/*
7570ef02cd6SEric Auger 	 * disable 8195, check dev2/eventid=20 does not trigger the
7580ef02cd6SEric Auger 	 * corresponding LPI
7590ef02cd6SEric Auger 	 */
7600ef02cd6SEric Auger 	gicv3_lpi_set_config(8195, LPI_PROP_DEFAULT & ~LPI_PROP_ENABLED);
7610ef02cd6SEric Auger 	its_send_inv(dev2, 20);
7620ef02cd6SEric Auger 
7630ef02cd6SEric Auger 	lpi_stats_expect(-1, -1);
7640ef02cd6SEric Auger 	its_send_int(dev2, 20);
7650ef02cd6SEric Auger 	check_lpi_stats("dev2/eventid=20 does not trigger any LPI");
7660ef02cd6SEric Auger 
7670ef02cd6SEric Auger 	/*
7680ef02cd6SEric Auger 	 * re-enable the LPI but willingly do not call invall
7690ef02cd6SEric Auger 	 * so the change in config is not taken into account.
7700ef02cd6SEric Auger 	 * The LPI should not hit
7710ef02cd6SEric Auger 	 */
7720ef02cd6SEric Auger 	gicv3_lpi_set_config(8195, LPI_PROP_DEFAULT);
7730ef02cd6SEric Auger 	lpi_stats_expect(-1, -1);
7740ef02cd6SEric Auger 	its_send_int(dev2, 20);
7750ef02cd6SEric Auger 	check_lpi_stats("dev2/eventid=20 still does not trigger any LPI");
7760ef02cd6SEric Auger 
7770ef02cd6SEric Auger 	/* Now call the invall and check the LPI hits */
7780ef02cd6SEric Auger 	its_send_invall(col3);
7790ef02cd6SEric Auger 	lpi_stats_expect(3, 8195);
7800ef02cd6SEric Auger 	its_send_int(dev2, 20);
7810ef02cd6SEric Auger 	check_lpi_stats("dev2/eventid=20 now triggers an LPI");
7820ef02cd6SEric Auger 
7830ef02cd6SEric Auger 	report_prefix_pop();
7840ef02cd6SEric Auger 
7850ef02cd6SEric Auger 	report_prefix_push("mapd valid=false");
7860ef02cd6SEric Auger 	/*
7870ef02cd6SEric Auger 	 * Unmap device 2 and check the eventid 20 formerly
7880ef02cd6SEric Auger 	 * attached to it does not hit anymore
7890ef02cd6SEric Auger 	 */
7900ef02cd6SEric Auger 
7910ef02cd6SEric Auger 	its_send_mapd(dev2, false);
7920ef02cd6SEric Auger 	lpi_stats_expect(-1, -1);
7930ef02cd6SEric Auger 	its_send_int(dev2, 20);
7940ef02cd6SEric Auger 	check_lpi_stats("no LPI after device unmap");
7950ef02cd6SEric Auger 	report_prefix_pop();
7960ef02cd6SEric Auger }
79764260a5fSEric Auger 
79864260a5fSEric Auger static void test_its_migration(void)
79964260a5fSEric Auger {
80064260a5fSEric Auger 	struct its_device *dev2, *dev7;
80164260a5fSEric Auger 	bool test_skipped = false;
80264260a5fSEric Auger 
80364260a5fSEric Auger 	if (its_setup1()) {
80464260a5fSEric Auger 		test_skipped = true;
80564260a5fSEric Auger 		goto do_migrate;
80664260a5fSEric Auger 	}
80764260a5fSEric Auger 
80864260a5fSEric Auger 	dev2 = its_get_device(2);
80964260a5fSEric Auger 	dev7 = its_get_device(7);
81064260a5fSEric Auger 
81164260a5fSEric Auger do_migrate:
81264260a5fSEric Auger 	puts("Now migrate the VM, then press a key to continue...\n");
81364260a5fSEric Auger 	(void)getchar();
81464260a5fSEric Auger 	report_info("Migration complete");
81564260a5fSEric Auger 	if (test_skipped)
81664260a5fSEric Auger 		return;
81764260a5fSEric Auger 
81864260a5fSEric Auger 	lpi_stats_expect(3, 8195);
81964260a5fSEric Auger 	its_send_int(dev2, 20);
82064260a5fSEric Auger 	check_lpi_stats("dev2/eventid=20 triggers LPI 8195 on PE #3 after migration");
82164260a5fSEric Auger 
82264260a5fSEric Auger 	lpi_stats_expect(2, 8196);
82364260a5fSEric Auger 	its_send_int(dev7, 255);
82464260a5fSEric Auger 	check_lpi_stats("dev7/eventid=255 triggers LPI 8196 on PE #2 after migration");
82564260a5fSEric Auger }
826de582149SEric Auger 
827de582149SEric Auger #define ERRATA_UNMAPPED_COLLECTIONS "ERRATA_8c58be34494b"
828de582149SEric Auger 
829de582149SEric Auger static void test_migrate_unmapped_collection(void)
830de582149SEric Auger {
831de582149SEric Auger 	struct its_collection *col = NULL;
832de582149SEric Auger 	struct its_device *dev2 = NULL, *dev7 = NULL;
833de582149SEric Auger 	bool test_skipped = false;
834de582149SEric Auger 	int pe0 = 0;
835de582149SEric Auger 	u8 config;
836de582149SEric Auger 
837de582149SEric Auger 	if (its_setup1()) {
838de582149SEric Auger 		test_skipped = true;
839de582149SEric Auger 		goto do_migrate;
840de582149SEric Auger 	}
841de582149SEric Auger 
842de582149SEric Auger 	if (!errata(ERRATA_UNMAPPED_COLLECTIONS)) {
843de582149SEric Auger 		report_skip("Skipping test, as this test hangs without the fix. "
844de582149SEric Auger 			    "Set %s=y to enable.", ERRATA_UNMAPPED_COLLECTIONS);
845de582149SEric Auger 		test_skipped = true;
846de582149SEric Auger 		goto do_migrate;
847de582149SEric Auger 	}
848de582149SEric Auger 
849de582149SEric Auger 	col = its_create_collection(pe0, pe0);
850de582149SEric Auger 	dev2 = its_get_device(2);
851de582149SEric Auger 	dev7 = its_get_device(7);
852de582149SEric Auger 
853de582149SEric Auger 	/* MAPTI with the collection unmapped */
854de582149SEric Auger 	its_send_mapti(dev2, 8192, 0, col);
855de582149SEric Auger 	gicv3_lpi_set_config(8192, LPI_PROP_DEFAULT);
856de582149SEric Auger 
857de582149SEric Auger do_migrate:
858de582149SEric Auger 	puts("Now migrate the VM, then press a key to continue...\n");
859de582149SEric Auger 	(void)getchar();
860de582149SEric Auger 	report_info("Migration complete");
861de582149SEric Auger 	if (test_skipped)
862de582149SEric Auger 		return;
863de582149SEric Auger 
864de582149SEric Auger 	/* on the destination, map the collection */
865de582149SEric Auger 	its_send_mapc(col, true);
866de582149SEric Auger 	its_send_invall(col);
867de582149SEric Auger 
868de582149SEric Auger 	lpi_stats_expect(2, 8196);
869de582149SEric Auger 	its_send_int(dev7, 255);
870de582149SEric Auger 	check_lpi_stats("dev7/eventid= 255 triggered LPI 8196 on PE #2");
871de582149SEric Auger 
872de582149SEric Auger 	config = gicv3_lpi_get_config(8192);
873de582149SEric Auger 	report(config == LPI_PROP_DEFAULT,
874de582149SEric Auger 	       "Config of LPI 8192 was properly migrated");
875de582149SEric Auger 
876de582149SEric Auger 	lpi_stats_expect(pe0, 8192);
877de582149SEric Auger 	its_send_int(dev2, 0);
878de582149SEric Auger 	check_lpi_stats("dev2/eventid = 0 triggered LPI 8192 on PE0");
879de582149SEric Auger }
880de582149SEric Auger 
881de582149SEric Auger static void test_its_pending_migration(void)
882de582149SEric Auger {
883de582149SEric Auger 	struct its_device *dev;
884de582149SEric Auger 	struct its_collection *collection[2];
885de582149SEric Auger 	int *expected = calloc(nr_cpus, sizeof(int));
886de582149SEric Auger 	int pe0 = nr_cpus - 1, pe1 = nr_cpus - 2;
887de582149SEric Auger 	bool test_skipped = false;
888de582149SEric Auger 	u64 pendbaser;
889de582149SEric Auger 	void *ptr;
890de582149SEric Auger 	int i;
891de582149SEric Auger 
892de582149SEric Auger 	if (its_prerequisites(4)) {
893de582149SEric Auger 		test_skipped = true;
894de582149SEric Auger 		goto do_migrate;
895de582149SEric Auger 	}
896de582149SEric Auger 
897de582149SEric Auger 	dev = its_create_device(2 /* dev id */, 8 /* nb_ites */);
898de582149SEric Auger 	its_send_mapd(dev, true);
899de582149SEric Auger 
900de582149SEric Auger 	collection[0] = its_create_collection(pe0, pe0);
901de582149SEric Auger 	collection[1] = its_create_collection(pe1, pe1);
902de582149SEric Auger 	its_send_mapc(collection[0], true);
903de582149SEric Auger 	its_send_mapc(collection[1], true);
904de582149SEric Auger 
905de582149SEric Auger 	/* disable lpi at redist level */
906de582149SEric Auger 	gicv3_lpi_rdist_disable(pe0);
907de582149SEric Auger 	gicv3_lpi_rdist_disable(pe1);
908de582149SEric Auger 
909de582149SEric Auger 	/* lpis are interleaved inbetween the 2 PEs */
910de582149SEric Auger 	for (i = 0; i < 256; i++) {
911de582149SEric Auger 		struct its_collection *col = i % 2 ? collection[0] :
912de582149SEric Auger 						     collection[1];
913de582149SEric Auger 		int vcpu = col->target_address >> 16;
914de582149SEric Auger 
915de582149SEric Auger 		its_send_mapti(dev, LPI(i), i, col);
916de582149SEric Auger 		gicv3_lpi_set_config(LPI(i), LPI_PROP_DEFAULT);
917de582149SEric Auger 		gicv3_lpi_set_clr_pending(vcpu, LPI(i), true);
918de582149SEric Auger 	}
919de582149SEric Auger 	its_send_invall(collection[0]);
920de582149SEric Auger 	its_send_invall(collection[1]);
921de582149SEric Auger 
922de582149SEric Auger 	/* Clear the PTZ bit on each pendbaser */
923de582149SEric Auger 
924de582149SEric Auger 	expected[pe0] = 128;
925de582149SEric Auger 	expected[pe1] = 128;
926de582149SEric Auger 
927de582149SEric Auger 	ptr = gicv3_data.redist_base[pe0] + GICR_PENDBASER;
928de582149SEric Auger 	pendbaser = readq(ptr);
929de582149SEric Auger 	writeq(pendbaser & ~GICR_PENDBASER_PTZ, ptr);
930de582149SEric Auger 
931de582149SEric Auger 	ptr = gicv3_data.redist_base[pe1] + GICR_PENDBASER;
932de582149SEric Auger 	pendbaser = readq(ptr);
933de582149SEric Auger 	writeq(pendbaser & ~GICR_PENDBASER_PTZ, ptr);
934de582149SEric Auger 
935de582149SEric Auger 	gicv3_lpi_rdist_enable(pe0);
936de582149SEric Auger 	gicv3_lpi_rdist_enable(pe1);
937de582149SEric Auger 
938de582149SEric Auger do_migrate:
939de582149SEric Auger 	puts("Now migrate the VM, then press a key to continue...\n");
940de582149SEric Auger 	(void)getchar();
941de582149SEric Auger 	report_info("Migration complete");
942de582149SEric Auger 	if (test_skipped)
943de582149SEric Auger 		return;
944de582149SEric Auger 
945de582149SEric Auger 	/* let's wait for the 256 LPIs to be handled */
946de582149SEric Auger 	mdelay(1000);
947de582149SEric Auger 
948de582149SEric Auger 	check_lpi_hits(expected, "128 LPIs on both PE0 and PE1 after migration");
949de582149SEric Auger }
950ba74b106SEric Auger #endif
951ba74b106SEric Auger 
952ac4a67b6SAndrew Jones int main(int argc, char **argv)
953ac4a67b6SAndrew Jones {
9542e2d471dSAndrew Jones 	if (!gic_init()) {
955ac4a67b6SAndrew Jones 		printf("No supported gic present, skipping tests...\n");
956ac4a67b6SAndrew Jones 		return report_summary();
957ac4a67b6SAndrew Jones 	}
958ac4a67b6SAndrew Jones 
9592b19b829SAndrew Jones 	report_prefix_pushf("gicv%d", gic_version());
960ac4a67b6SAndrew Jones 
9612e2d471dSAndrew Jones 	switch (gic_version()) {
9622e2d471dSAndrew Jones 	case 2:
9632e2d471dSAndrew Jones 		gic = &gicv2;
9642e2d471dSAndrew Jones 		break;
9652e2d471dSAndrew Jones 	case 3:
9662e2d471dSAndrew Jones 		gic = &gicv3;
9672e2d471dSAndrew Jones 		break;
9682e2d471dSAndrew Jones 	}
9692e2d471dSAndrew Jones 
970ac4a67b6SAndrew Jones 	if (argc < 2)
971ac4a67b6SAndrew Jones 		report_abort("no test specified");
972ac4a67b6SAndrew Jones 
973ac4a67b6SAndrew Jones 	if (strcmp(argv[1], "ipi") == 0) {
974ac4a67b6SAndrew Jones 		report_prefix_push(argv[1]);
975ac4a67b6SAndrew Jones 		nr_cpu_check(2);
97600b34f56SAndrew Jones 		on_cpus(ipi_test, NULL);
977c152d8bcSChristoffer Dall 	} else if (strcmp(argv[1], "active") == 0) {
978c152d8bcSChristoffer Dall 		run_active_clear_test();
97978ad7e95SAndre Przywara 	} else if (strcmp(argv[1], "mmio") == 0) {
98078ad7e95SAndre Przywara 		report_prefix_push(argv[1]);
98178ad7e95SAndre Przywara 		gic_test_mmio();
98278ad7e95SAndre Przywara 		report_prefix_pop();
9830ef02cd6SEric Auger 	} else if (!strcmp(argv[1], "its-trigger")) {
9840ef02cd6SEric Auger 		report_prefix_push(argv[1]);
9850ef02cd6SEric Auger 		test_its_trigger();
9860ef02cd6SEric Auger 		report_prefix_pop();
98764260a5fSEric Auger 	} else if (!strcmp(argv[1], "its-migration")) {
98864260a5fSEric Auger 		report_prefix_push(argv[1]);
98964260a5fSEric Auger 		test_its_migration();
99064260a5fSEric Auger 		report_prefix_pop();
991de582149SEric Auger 	} else if (!strcmp(argv[1], "its-pending-migration")) {
992de582149SEric Auger 		report_prefix_push(argv[1]);
993de582149SEric Auger 		test_its_pending_migration();
994de582149SEric Auger 		report_prefix_pop();
995de582149SEric Auger 	} else if (!strcmp(argv[1], "its-migrate-unmapped-collection")) {
996de582149SEric Auger 		report_prefix_push(argv[1]);
997de582149SEric Auger 		test_migrate_unmapped_collection();
998de582149SEric Auger 		report_prefix_pop();
999ba74b106SEric Auger 	} else if (strcmp(argv[1], "its-introspection") == 0) {
1000ba74b106SEric Auger 		report_prefix_push(argv[1]);
1001ba74b106SEric Auger 		test_its_introspection();
1002ba74b106SEric Auger 		report_prefix_pop();
1003ac4a67b6SAndrew Jones 	} else {
1004ac4a67b6SAndrew Jones 		report_abort("Unknown subtest '%s'", argv[1]);
1005ac4a67b6SAndrew Jones 	}
1006ac4a67b6SAndrew Jones 
1007ac4a67b6SAndrew Jones 	return report_summary();
1008ac4a67b6SAndrew Jones }
1009