Permit the use of the TPIDRPRW system register for carrying the per-CPU offset in generic SMP configurations that also target non-SMP capable ARMv6 cores. This uses the SMP_ON_UP code patching framework to turn all TPIDRPRW accesses into reads/writes of entry #0 in the __per_cpu_offset array. While at it, switch over some existing direct TPIDRPRW accesses in asm code to invocations of a new helper that is patched in the same way when necessary. Note that CPU_V6+SMP without SMP_ON_UP results in a kernel that does not boot on v6 CPUs without SMP extensions, so add this dependency to Kconfig as well. Acked-by: Linus Walleij <linus.walleij@linaro.org> Acked-by: Nicolas Pitre <nico@fluxnic.net> Signed-off-by: Ard Biesheuvel <ardb@kernel.org> Tested-by: Marc Zyngier <maz@kernel.org> Tested-by: Vladimir Murzin <vladimir.murzin@arm.com> # ARMv7M
62 lines
1.5 KiB
C
62 lines
1.5 KiB
C
/* SPDX-License-Identifier: GPL-2.0-only */
|
|
/*
|
|
* Copyright 2012 Calxeda, Inc.
|
|
*/
|
|
#ifndef _ASM_ARM_PERCPU_H_
|
|
#define _ASM_ARM_PERCPU_H_
|
|
|
|
#include <asm/insn.h>
|
|
|
|
register unsigned long current_stack_pointer asm ("sp");
|
|
|
|
/*
|
|
* Same as asm-generic/percpu.h, except that we store the per cpu offset
|
|
* in the TPIDRPRW. TPIDRPRW only exists on V6K and V7
|
|
*/
|
|
#ifdef CONFIG_SMP
|
|
static inline void set_my_cpu_offset(unsigned long off)
|
|
{
|
|
extern unsigned int smp_on_up;
|
|
|
|
if (IS_ENABLED(CONFIG_CPU_V6) && !smp_on_up)
|
|
return;
|
|
|
|
/* Set TPIDRPRW */
|
|
asm volatile("mcr p15, 0, %0, c13, c0, 4" : : "r" (off) : "memory");
|
|
}
|
|
|
|
static inline unsigned long __my_cpu_offset(void)
|
|
{
|
|
unsigned long off;
|
|
|
|
/*
|
|
* Read TPIDRPRW.
|
|
* We want to allow caching the value, so avoid using volatile and
|
|
* instead use a fake stack read to hazard against barrier().
|
|
*/
|
|
asm("0: mrc p15, 0, %0, c13, c0, 4 \n\t"
|
|
#ifdef CONFIG_CPU_V6
|
|
"1: \n\t"
|
|
" .subsection 1 \n\t"
|
|
"2: " LOAD_SYM_ARMV6(%0, __per_cpu_offset) " \n\t"
|
|
" b 1b \n\t"
|
|
" .previous \n\t"
|
|
" .pushsection \".alt.smp.init\", \"a\" \n\t"
|
|
" .long 0b - . \n\t"
|
|
" b . + (2b - 0b) \n\t"
|
|
" .popsection \n\t"
|
|
#endif
|
|
: "=r" (off)
|
|
: "Q" (*(const unsigned long *)current_stack_pointer));
|
|
|
|
return off;
|
|
}
|
|
#define __my_cpu_offset __my_cpu_offset()
|
|
#else
|
|
#define set_my_cpu_offset(x) do {} while(0)
|
|
|
|
#endif /* CONFIG_SMP */
|
|
|
|
#include <asm-generic/percpu.h>
|
|
|
|
#endif /* _ASM_ARM_PERCPU_H_ */
|