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