On 13.05.16 10:40, Alison Wang wrote:
> To support loading a 32-bit OS, the execution state will change from
> AArch64 to AArch32 when jumping to kernel.
> 
> The architecture information will be got through checking FIT
> image, then U-Boot will load 32-bit OS or 64-bit OS automatically.
> 
> Signed-off-by: Ebony Zhu <ebony....@nxp.com>
> Signed-off-by: Alison Wang <alison.w...@nxp.com>
> Signed-off-by: Chenhui Zhao <chenhui.z...@nxp.com>
> ---
>  arch/arm/cpu/armv8/transition.S | 100 
> ++++++++++++++++++++++++++++++++++++++++
>  arch/arm/include/asm/system.h   |   2 +
>  arch/arm/lib/bootm.c            |  20 +++++++-
>  common/image-fit.c              |  12 ++++-
>  4 files changed, 131 insertions(+), 3 deletions(-)
> 
> diff --git a/arch/arm/cpu/armv8/transition.S b/arch/arm/cpu/armv8/transition.S
> index 253a39b..9d7a17a 100644
> --- a/arch/arm/cpu/armv8/transition.S
> +++ b/arch/arm/cpu/armv8/transition.S
> @@ -21,3 +21,103 @@ ENTRY(armv8_switch_to_el1)
>  0:   ret
>  1:   armv8_switch_to_el1_m x0, x1
>  ENDPROC(armv8_switch_to_el1)
> +
> +/*
> + * x0: kernel entry point
> + * x1: machine nr
> + * x2: fdt address
> + */
> +ENTRY(armv8_switch_to_el2_aarch32)
> +     switch_el x3, 1f, 0f, 0f
> +0:   ret
> +1:
> +     mov     x7, x0
> +     mov     x8, x1
> +     mov     x9, x2
> +
> +     /* 32bit EL2 | HCE | SMD | RES1 (Bits[5:4]) | Non-secure EL0/EL1 */
> +     mov     x1, 0x1b1
> +     msr     scr_el3, x1
> +     msr     cptr_el3, xzr   /* Disable coprocessor traps to EL3 */
> +     mov     x1, 0x33ff
> +     msr     cptr_el2, x1    /* Disable coprocessor traps to EL2 */
> +
> +     /* Initialize Generic Timers */
> +     msr     cntvoff_el2, xzr
> +
> +     mov     x1, #0x0830
> +     movk    x1, #0x30c5, lsl #16
> +     msr     sctlr_el2, x1

Why is this necessary?

> +
> +     /* Return to AArch32 Hypervisor mode */
> +     mov     x1, sp
> +     msr     sp_el2, x1
> +     mrs     x1, vbar_el3
> +     msr     vbar_el2, x1    /* Migrate VBAR */
> +     mov     x1, #0x1da
> +     msr     spsr_el3, x1
> +     msr     elr_el3, x7
> +
> +     mov     x0, #0
> +     mov     x1, x8
> +     mov     x2, x9
> +
> +     eret
> +ENDPROC(armv8_switch_to_el2_aarch32)

This whole thing looks like a copy of armv8_switch_to_el2_m. Just
parameterize that one and put the few bits that are different in macro ifs.

> +
> +/*
> + * x0: kernel entry point
> + * x1: machine nr
> + * x2: fdt address
> + */
> +ENTRY(armv8_switch_to_el1_aarch32)
> +     switch_el x3, 0f, 1f, 0f
> +0:   ret
> +1:
> +     mov     x7, x0
> +     mov     x8, x1
> +     mov     x9, x2
> +
> +     /* Initialize Generic Timers */
> +     mrs     x0, cnthctl_el2
> +     orr     x0, x0, #0x3            /* Enable EL1 access to timers */
> +     msr     cnthctl_el2, x0
> +     msr     cntvoff_el2, xzr
> +
> +        /* Initialize MPID/MPIDR registers */
> +     mrs     x0, midr_el1
> +     mrs     x1, mpidr_el1
> +     msr     vpidr_el2, x0
> +     msr     vmpidr_el2, x1
> +
> +        /* Disable coprocessor traps */
> +     mov     x0, #0x33ff
> +     msr     cptr_el2, x0            /* Disable coprocessor traps to EL2 */
> +        msr  hstr_el2, xzr           /* Disable coprocessor traps to EL2 */
> +        mov  x0, #3 << 20
> +        msr  cpacr_el1, x0           /* Enable FP/SIMD at EL1 */
> +
> +     /* Initialize HCR_EL2 */
> +     mov     x0, #(0 << 31)          /* 32bit EL1 */
> +     orr     x0, x0, #(1 << 29)      /* Disable HVC */
> +     msr     hcr_el2, x0
> +
> +     mov     x0, #0x0800
> +     movk    x0, #0x30d0, lsl #16
> +     msr     sctlr_el1, x0
> +
> +     /* Return to AArch32 Supervisor mode */
> +     mov     x0, sp
> +     msr     sp_el1, x0              /* Migrate SP */
> +     mrs     x0, vbar_el2
> +     msr     vbar_el1, x0            /* Migrate VBAR */
> +     mov     x0, #0x1d3
> +     msr     spsr_el2, x0
> +     msr     elr_el2, x7
> +
> +     mov     x0, #0
> +     mov     x1, x8
> +     mov     x2, x9
> +
> +     eret
> +ENDPROC(armv8_switch_to_el1_aarch32)

Does anybody really care about jumping to el1?

> diff --git a/arch/arm/include/asm/system.h b/arch/arm/include/asm/system.h
> index 9ae890a..bb87cf0 100644
> --- a/arch/arm/include/asm/system.h
> +++ b/arch/arm/include/asm/system.h
> @@ -102,6 +102,8 @@ void __asm_switch_ttbr(u64 new_ttbr);
>  
>  void armv8_switch_to_el2(void);
>  void armv8_switch_to_el1(void);
> +void armv8_switch_to_el2_aarch32(u64 entry_point, u64 mach_nr, u64 fdt_addr);
> +void armv8_switch_to_el1_aarch32(u64 entry_point, u64 mach_nr, u64 fdt_addr);
>  void gic_init(void);
>  void gic_send_sgi(unsigned long sgino);
>  void wait_for_wakeup(void);
> diff --git a/arch/arm/lib/bootm.c b/arch/arm/lib/bootm.c
> index 0838d89..a39c3d2 100644
> --- a/arch/arm/lib/bootm.c
> +++ b/arch/arm/lib/bootm.c
> @@ -286,8 +286,24 @@ static void boot_jump_linux(bootm_headers_t *images, int 
> flag)
>       announce_and_cleanup(fake);
>  
>       if (!fake) {
> -             do_nonsec_virt_switch();
> -             kernel_entry(images->ft_addr, NULL, NULL, NULL);
> +             if ((IH_ARCH_DEFAULT == IH_ARCH_ARM64) &&
> +                 (images->os.arch == IH_ARCH_ARM)) {
> +                     smp_kick_all_cpus();
> +                     dcache_disable();
> +#ifdef CONFIG_ARMV8_SWITCH_TO_EL1
> +                     armv8_switch_to_el2();
> +                     armv8_switch_to_el1_aarch32((u64)images->ep,
> +                                                 (u64)gd->bd->bi_arch_number,
> +                                                 (u64)images->ft_addr);
> +#else
> +                     armv8_switch_to_el2_aarch32((u64)images->ep,
> +                                                 (u64)gd->bd->bi_arch_number,
> +                                                 (u64)images->ft_addr);
> +#endif

Does this compile on 32bit targets?


Alex
_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to