On Wed, Jan 18, 2023 at 02:49:11PM +0000, Alexandru Elisei wrote: > For the PSCI CPU_ON function test, all other CPUs perform a CPU_ON call > that target CPU 1. The test is considered a success if CPU_ON returns PSCI > SUCCESS exactly once, and for the rest of the calls PSCI ALREADY_ON. > > Enhance the test by checking that CPU 1 is actually online and able to > execute code. Also make the test more robust by checking that the CPU_ON > call returns, instead of assuming that it will always succeed and > hanging indefinitely if it doesn't. > > Since the CPU 1 thread is now being set up properly by kvm-unit-tests > when being brought online, it becomes possible to add other tests in the > future that require all CPUs. > > The include header order in arm/psci.c has been changed to be in > alphabetic order. This means moving the errata.h include before > libcflat.h, which causes compilation to fail because of missing includes > in errata.h. Fix that also by including the needed header in errata.h. > > Signed-off-by: Alexandru Elisei <alexandru.elisei@xxxxxxx> > --- > arm/psci.c | 60 ++++++++++++++++++++++++++++++++++++----------- > lib/arm/asm/smp.h | 1 + > lib/arm/smp.c | 12 +++++++--- > lib/errata.h | 2 ++ > 4 files changed, 58 insertions(+), 17 deletions(-) > > diff --git a/arm/psci.c b/arm/psci.c > index efa0722c0566..e96be941953b 100644 > --- a/arm/psci.c > +++ b/arm/psci.c > @@ -7,11 +7,13 @@ > * > * This work is licensed under the terms of the GNU LGPL, version 2. > */ > -#include <libcflat.h> > #include <errata.h> > +#include <libcflat.h> > + > +#include <asm/delay.h> > #include <asm/processor.h> > -#include <asm/smp.h> > #include <asm/psci.h> > +#include <asm/smp.h> > > static bool invalid_function_exception; > > @@ -72,14 +74,23 @@ static int cpu_on_ret[NR_CPUS]; > static cpumask_t cpu_on_ready, cpu_on_done; > static volatile int cpu_on_start; > > -static void cpu_on_secondary_entry(void) > +extern void secondary_entry(void); > +static void cpu_on_do_wake_target(void) > { > int cpu = smp_processor_id(); > > cpumask_set_cpu(cpu, &cpu_on_ready); > while (!cpu_on_start) > cpu_relax(); > - cpu_on_ret[cpu] = psci_cpu_on(cpus[1], __pa(halt)); > + cpu_on_ret[cpu] = psci_cpu_on(cpus[1], __pa(secondary_entry)); > + cpumask_set_cpu(cpu, &cpu_on_done); > +} > + > +static void cpu_on_target(void) > +{ > + int cpu = smp_processor_id(); > + > + cpu_on_ret[cpu] = PSCI_RET_ALREADY_ON; > cpumask_set_cpu(cpu, &cpu_on_done); > } > > @@ -87,33 +98,53 @@ static bool psci_cpu_on_test(void) > { > bool failed = false; > int ret_success = 0; > - int cpu; > - > - cpumask_set_cpu(1, &cpu_on_ready); > - cpumask_set_cpu(1, &cpu_on_done); > + int i, cpu; > > for_each_present_cpu(cpu) { > if (cpu < 2) > continue; > - smp_boot_secondary(cpu, cpu_on_secondary_entry); > + smp_boot_secondary(cpu, cpu_on_do_wake_target); > } > > cpumask_set_cpu(0, &cpu_on_ready); > + cpumask_set_cpu(1, &cpu_on_ready); > while (!cpumask_full(&cpu_on_ready)) > cpu_relax(); > > + /* > + * Wait for all other CPUs to be online before configuring the thread > + * for the target CPU, as all secondaries are set up using the same > + * global variable. > + */ > + smp_prepare_secondary(1, cpu_on_target); > + > cpu_on_start = 1; > smp_mb(); > > - cpu_on_ret[0] = psci_cpu_on(cpus[1], __pa(halt)); > + cpu_on_ret[0] = psci_cpu_on(cpus[1], __pa(secondary_entry)); > cpumask_set_cpu(0, &cpu_on_done); > > - while (!cpumask_full(&cpu_on_done)) > - cpu_relax(); > + report_info("waiting for CPU1 to come online..."); > + for (i = 0; i < 10; i++) { > + mdelay(100); Changing this to for (i = 0; i < 100; i++) { mdelay(10); may speed it up a bit. Thanks, drew > + if (cpumask_full(&cpu_on_done)) > + break; > + } > + > + if (!cpumask_full(&cpu_on_done)) { > + for_each_present_cpu(cpu) { > + if (!cpumask_test_cpu(cpu, &cpu_on_done)) { > + if (cpu == 1) > + report_info("CPU1 failed to come online"); > + else > + report_info("CPU%d failed to online CPU1", cpu); > + } > + } > + failed = true; > + goto out; > + } > > for_each_present_cpu(cpu) { > - if (cpu == 1) > - continue; > if (cpu_on_ret[cpu] == PSCI_RET_SUCCESS) { > ret_success++; > } else if (cpu_on_ret[cpu] != PSCI_RET_ALREADY_ON) { > @@ -127,6 +158,7 @@ static bool psci_cpu_on_test(void) > failed = true; > } > > +out: > return !failed; > } > > diff --git a/lib/arm/asm/smp.h b/lib/arm/asm/smp.h > index 077afde85520..ff2ef8f88247 100644 > --- a/lib/arm/asm/smp.h > +++ b/lib/arm/asm/smp.h > @@ -49,6 +49,7 @@ static inline void set_cpu_idle(int cpu, bool idle) > } > > typedef void (*secondary_entry_fn)(void); > +extern void smp_prepare_secondary(int cpu, secondary_entry_fn entry); > extern void smp_boot_secondary(int cpu, secondary_entry_fn entry); > extern void on_cpu_async(int cpu, void (*func)(void *data), void *data); > extern void on_cpu(int cpu, void (*func)(void *data), void *data); > diff --git a/lib/arm/smp.c b/lib/arm/smp.c > index 98a5054e039b..947f417f4aea 100644 > --- a/lib/arm/smp.c > +++ b/lib/arm/smp.c > @@ -58,13 +58,19 @@ secondary_entry_fn secondary_cinit(void) > return entry; > } > > -static void __smp_boot_secondary(int cpu, secondary_entry_fn entry) > +void smp_prepare_secondary(int cpu, secondary_entry_fn entry) > { > - int ret; > - > secondary_data.stack = thread_stack_alloc(); > secondary_data.entry = entry; > mmu_mark_disabled(cpu); > +} > + > +static void __smp_boot_secondary(int cpu, secondary_entry_fn entry) > +{ > + int ret; > + > + smp_prepare_secondary(cpu, entry); > + > ret = cpu_psci_cpu_boot(cpu); > assert(ret == 0); > > diff --git a/lib/errata.h b/lib/errata.h > index 5af0eb3bf8e2..de8205d8b370 100644 > --- a/lib/errata.h > +++ b/lib/errata.h > @@ -6,6 +6,8 @@ > */ > #ifndef _ERRATA_H_ > #define _ERRATA_H_ > +#include <libcflat.h> > + > #include "config.h" > > #ifndef CONFIG_ERRATA_FORCE > -- > 2.25.1 >