[U-Boot] [PATCH] ARM: non-sec: Add spin table reserved memory support

[Marc Zyngier <marc.zyngier@arm.com>]

On 07/08/14 02:54, Xiubo Li wrote:
> The memory where loaded the smp_waitloop code section probablly
> be corrupted by Linux Kernel, then the secondary cores will be
> running the random code, leading booting the secondary cores
> failed.

There is now similar reservation code in virt-dt.c. Probably some form
of consolidation is in order.

Thanks,

	M.

> Signed-off-by: Xiubo Li <Li.Xiubo@freescale.com>
> ---
>  arch/arm/cpu/armv7/nonsec_virt.S |  6 ++++++
>  arch/arm/include/asm/nonsecure.h | 14 ++++++++++++++
>  arch/arm/lib/Makefile            |  4 ++++
>  arch/arm/lib/nonsecure.c         | 34 ++++++++++++++++++++++++++++++++++
>  4 files changed, 58 insertions(+)
>  create mode 100644 arch/arm/include/asm/nonsecure.h
>  create mode 100644 arch/arm/lib/nonsecure.c
> 
> diff --git a/arch/arm/cpu/armv7/nonsec_virt.S b/arch/arm/cpu/armv7/nonsec_virt.S
> index c334a15..e3a62af 100644
> --- a/arch/arm/cpu/armv7/nonsec_virt.S
> +++ b/arch/arm/cpu/armv7/nonsec_virt.S
> @@ -175,6 +175,9 @@ ENTRY(_nonsec_init)
>  	bx	lr
>  ENDPROC(_nonsec_init)
>  
> +.globl smp_waitloop_start
> +smp_waitloop_start:
> +	.word .
>  #ifdef CONFIG_SMP_PEN_ADDR
>  /* void __weak smp_waitloop(unsigned previous_address); */
>  ENTRY(smp_waitloop)
> @@ -190,6 +193,9 @@ ENTRY(smp_waitloop)
>  ENDPROC(smp_waitloop)
>  .weak smp_waitloop
>  #endif
> +.globl smp_waitloop_end
> +smp_waitloop_end:
> +	.word .
>  
>  ENTRY(_switch_to_hyp)
>  	mov	r0, lr
> diff --git a/arch/arm/include/asm/nonsecure.h b/arch/arm/include/asm/nonsecure.h
> new file mode 100644
> index 0000000..31a4071
> --- /dev/null
> +++ b/arch/arm/include/asm/nonsecure.h
> @@ -0,0 +1,14 @@
> +/*
> + * Copyright (c) 2014 Freescale Semiconductor, Inc.
> + *
> + * SPDX-License-Identifier:	GPL-2.0+
> + */
> +
> +#ifndef _ARM_NONSECURE_H_
> +#define _ARM_NONSECURE_H_
> +
> +extern ulong smp_waitloop_start;         /* start of image for smp spin table */
> +extern ulong smp_waitloop_end;         /* end of image for smp spin table */
> +int fdt_add_smp_waitloop_mem_rsv(void *blob);
> +
> +#endif /* _ARM_NONSECURE_H_ */
> diff --git a/arch/arm/lib/Makefile b/arch/arm/lib/Makefile
> index 321997c..fe707e9 100644
> --- a/arch/arm/lib/Makefile
> +++ b/arch/arm/lib/Makefile
> @@ -55,6 +55,10 @@ ifndef CONFIG_ARM64
>  obj-y	+= cache-cp15.o
>  endif
>  
> +ifneq ($(CONFIG_ARMV7_NONSEC)$(CONFIG_ARMV7_VIRT),)
> +obj-y   += nonsecure.o
> +endif
> +
>  # For EABI conformant tool chains, provide eabi_compat()
>  ifneq (,$(findstring -mabi=aapcs-linux,$(PLATFORM_CPPFLAGS)))
>  extra-y	+= eabi_compat.o
> diff --git a/arch/arm/lib/nonsecure.c b/arch/arm/lib/nonsecure.c
> new file mode 100644
> index 0000000..2a83669
> --- /dev/null
> +++ b/arch/arm/lib/nonsecure.c
> @@ -0,0 +1,34 @@
> +/*
> + * Copyright (c) 2014 Freescale Semiconductor, Inc.
> + *
> + * SPDX-License-Identifier:	GPL-2.0+
> + */
> +#include <common.h>
> +#include <asm/nonsecure.h>
> +#include <libfdt.h>
> +
> +#define PG_4K_ALING ~((1 << 12) - 1)
> +#define PG_4K (1 << 12)
> +
> +int fdt_add_smp_waitloop_mem_rsv(void *blob)
> +{
> +	unsigned long rsv_start = smp_waitloop_start & PG_4K_ALING;
> +	unsigned long rsv_end = smp_waitloop_end & PG_4K_ALING;
> +	unsigned long rsv_size;
> +	int off;
> +
> +	if (smp_waitloop_end == smp_waitloop_start + 0x4)
> +		return 0;
> +
> +	if (rsv_start != rsv_end)
> +		rsv_size = 2 * PG_4K;
> +	else
> +		rsv_size = PG_4K;
> +
> +	off = fdt_add_mem_rsv(blob, rsv_start, (u64)rsv_size);
> +	if (off < 0)
> +		printf("Failed to reserve memory for smp waitloop: %s\n",
> +				fdt_strerror(off));
> +
> +	return off;
> +}
> 


-- 
Jazz is not dead. It just smells funny...