mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-11-04 14:00:19 +00:00 
			
		
		
		
	Add low level platform initialization for the AST2600 SoC. The 2-stage booting with U-Boot SPL are leveraged to support different booting mode. However, currently the patch supports only the booting from memory-mapped SPI flash. Signed-off-by: Chia-Wei, Wang <chiawei_wang@aspeedtech.com> Reviewed-by: Ryan Chen <ryan_chen@aspeedtech.com>
		
			
				
	
	
		
			234 lines
		
	
	
		
			4.8 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
			
		
		
	
	
			234 lines
		
	
	
		
			4.8 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
	
	
/* SPDX-License-Identifier: GPL-2.0 */
 | 
						|
/*
 | 
						|
 * Copyright (c) ASPEED Technology Inc.
 | 
						|
 */
 | 
						|
#include <config.h>
 | 
						|
#include <asm/armv7.h>
 | 
						|
#include <linux/linkage.h>
 | 
						|
#include <asm/arch/scu_ast2600.h>
 | 
						|
 | 
						|
/* SCU register offsets */
 | 
						|
#define SCU_BASE		0x1e6e2000
 | 
						|
#define SCU_PROT_KEY1		(SCU_BASE + 0x000)
 | 
						|
#define SCU_PROT_KEY2		(SCU_BASE + 0x010)
 | 
						|
#define SCU_SMP_BOOT		(SCU_BASE + 0x180)
 | 
						|
#define SCU_HWSTRAP1		(SCU_BASE + 0x510)
 | 
						|
#define SCU_CA7_PARITY_CHK	(SCU_BASE + 0x820)
 | 
						|
#define SCU_CA7_PARITY_CLR	(SCU_BASE + 0x824)
 | 
						|
#define SCU_MMIO_DEC		(SCU_BASE + 0xc24)
 | 
						|
 | 
						|
/* FMC SPI register offsets */
 | 
						|
#define FMC_BASE		0x1e620000
 | 
						|
#define FMC_CE0_CTRL		(FMC_BASE + 0x010)
 | 
						|
#define FMC_SW_RST_CTRL		(FMC_BASE + 0x050)
 | 
						|
#define FMC_WDT1_CTRL_MODE	(FMC_BASE + 0x060)
 | 
						|
#define FMC_WDT2_CTRL_MODE	(FMC_BASE + 0x064)
 | 
						|
 | 
						|
/*
 | 
						|
 * The SMP mailbox provides a space with few instructions in it
 | 
						|
 * for secondary cores to execute on and wait for the signal of
 | 
						|
 * SMP core bring up.
 | 
						|
 *
 | 
						|
 *       SMP mailbox
 | 
						|
 * +----------------------+
 | 
						|
 * |                      |
 | 
						|
 * | mailbox insn. for    |
 | 
						|
 * | cpuN polling SMP go  |
 | 
						|
 * |                      |
 | 
						|
 * +----------------------+ 0xC
 | 
						|
 * | mailbox ready signal |
 | 
						|
 * +----------------------+ 0x8
 | 
						|
 * | cpuN GO signal       |
 | 
						|
 * +----------------------+ 0x4
 | 
						|
 * | cpuN entrypoint      |
 | 
						|
 * +----------------------+ SMP_MAILBOX_BASE
 | 
						|
 */
 | 
						|
#define SMP_MBOX_BASE		(SCU_SMP_BOOT)
 | 
						|
#define SMP_MBOX_FIELD_ENTRY	(SMP_MBOX_BASE + 0x0)
 | 
						|
#define SMP_MBOX_FIELD_GOSIGN	(SMP_MBOX_BASE + 0x4)
 | 
						|
#define SMP_MBOX_FIELD_READY	(SMP_MBOX_BASE + 0x8)
 | 
						|
#define SMP_MBOX_FIELD_POLLINSN	(SMP_MBOX_BASE + 0xc)
 | 
						|
 | 
						|
.macro scu_unlock
 | 
						|
	movw	r0, #(SCU_UNLOCK_KEY & 0xffff)
 | 
						|
	movt	r0, #(SCU_UNLOCK_KEY >> 16)
 | 
						|
 | 
						|
	ldr	r1, =SCU_PROT_KEY1
 | 
						|
	str	r0, [r1]
 | 
						|
	ldr	r1, =SCU_PROT_KEY2
 | 
						|
	str	r0, [r1]
 | 
						|
.endm
 | 
						|
 | 
						|
.macro timer_init
 | 
						|
	ldr	r1, =SCU_HWSTRAP1
 | 
						|
	ldr	r1, [r1]
 | 
						|
	and	r1, #0x700
 | 
						|
	lsr	r1, #0x8
 | 
						|
 | 
						|
	/* 1.2GHz */
 | 
						|
	cmp	r1, #0x0
 | 
						|
	movweq	r0, #0x8c00
 | 
						|
	movteq	r0, #0x4786
 | 
						|
 | 
						|
	/* 1.6GHz */
 | 
						|
	cmp	r1, #0x1
 | 
						|
	movweq	r0, #0x1000
 | 
						|
	movteq	r0, #0x5f5e
 | 
						|
 | 
						|
	/* 1.2GHz */
 | 
						|
	cmp	r1, #0x2
 | 
						|
	movweq	r0, #0x8c00
 | 
						|
	movteq	r0, #0x4786
 | 
						|
 | 
						|
	/* 1.6GHz */
 | 
						|
	cmp	r1, #0x3
 | 
						|
	movweq	r0, #0x1000
 | 
						|
	movteq	r0, #0x5f5e
 | 
						|
 | 
						|
	/* 800MHz */
 | 
						|
	cmp	r1, #0x4
 | 
						|
	movwge	r0, #0x0800
 | 
						|
	movtge	r0, #0x2faf
 | 
						|
 | 
						|
	mcr	p15, 0, r0, c14, c0, 0	@; update CNTFRQ
 | 
						|
.endm
 | 
						|
 | 
						|
 | 
						|
.globl lowlevel_init
 | 
						|
 | 
						|
lowlevel_init:
 | 
						|
#if defined(CONFIG_SPL) && !defined(CONFIG_SPL_BUILD)
 | 
						|
	mov	pc, lr
 | 
						|
#else
 | 
						|
	/* setup ARM arch timer frequency */
 | 
						|
	timer_init
 | 
						|
 | 
						|
	/* reset SMP mailbox as early as possible */
 | 
						|
	mov	r0, #0x0
 | 
						|
	ldr	r1, =SMP_MBOX_FIELD_READY
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
	/* set ACTLR.SMP to enable cache use */
 | 
						|
	mrc	p15, 0, r0, c1, c0, 1
 | 
						|
	orr	r0, #0x40
 | 
						|
	mcr	p15, 0, r0, c1, c0, 1
 | 
						|
 | 
						|
	/*
 | 
						|
	 * we treat cpu0 as the primary core and
 | 
						|
	 * put secondary core (cpuN) to sleep
 | 
						|
	 */
 | 
						|
	mrc   p15, 0, r0, c0, c0, 5	@; Read CPU ID register
 | 
						|
	ands  r0, #0xff			@; Mask off, leaving the CPU ID field
 | 
						|
	movw  r2, #0xab00
 | 
						|
	movt  r2, #0xabba
 | 
						|
	orr   r2, r0
 | 
						|
 | 
						|
	beq   do_primary_core_setup
 | 
						|
 | 
						|
	/* hold cpuN until mailbox is ready */
 | 
						|
poll_mailbox_ready:
 | 
						|
	wfe
 | 
						|
	ldr	r0, =SMP_MBOX_FIELD_READY
 | 
						|
	ldr	r0, [r0]
 | 
						|
	movw	r1, #0xcafe
 | 
						|
	movt	r1, #0xbabe
 | 
						|
	cmp	r1, r0
 | 
						|
	bne	poll_mailbox_ready
 | 
						|
 | 
						|
	/* parameters for relocated SMP go polling insn. */
 | 
						|
	ldr	r0, =SMP_MBOX_FIELD_GOSIGN
 | 
						|
	ldr	r1, =SMP_MBOX_FIELD_ENTRY
 | 
						|
 | 
						|
	/* no return */
 | 
						|
	ldr	pc, =SMP_MBOX_FIELD_POLLINSN
 | 
						|
 | 
						|
do_primary_core_setup:
 | 
						|
	scu_unlock
 | 
						|
 | 
						|
	/* MMIO decode setting */
 | 
						|
	ldr	r0, =SCU_MMIO_DEC
 | 
						|
	mov	r1, #0x2000
 | 
						|
	str	r1, [r0]
 | 
						|
 | 
						|
	/* enable CA7 cache parity check */
 | 
						|
	mov	r0, #0
 | 
						|
	ldr	r1, =SCU_CA7_PARITY_CLR
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
	mov	r0, #0x1
 | 
						|
	ldr	r1, =SCU_CA7_PARITY_CHK
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
	/* do not fill FMC50[1] if boot from eMMC */
 | 
						|
	ldr	r0, =SCU_HWSTRAP1
 | 
						|
	ldr	r1, [r0]
 | 
						|
	ands	r1, #0x04
 | 
						|
	bne	skip_fill_wip_bit
 | 
						|
 | 
						|
	/* fill FMC50[1] for waiting WIP idle */
 | 
						|
	mov	r0, #0x02
 | 
						|
	ldr	r1, =FMC_SW_RST_CTRL
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
skip_fill_wip_bit:
 | 
						|
	/* disable FMC WDT for SPI address mode detection */
 | 
						|
	mov	r0, #0
 | 
						|
	ldr	r1, =FMC_WDT1_CTRL_MODE
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
	/* relocate mailbox insn. for cpuN polling SMP go signal */
 | 
						|
	adrl	r0, mailbox_insn
 | 
						|
	adrl	r1, mailbox_insn_end
 | 
						|
 | 
						|
	ldr	r2, =#SMP_MBOX_FIELD_POLLINSN
 | 
						|
 | 
						|
relocate_mailbox_insn:
 | 
						|
	ldr	r3, [r0], #0x4
 | 
						|
	str	r3, [r2], #0x4
 | 
						|
	cmp	r0, r1
 | 
						|
	bne	relocate_mailbox_insn
 | 
						|
 | 
						|
	/* reset SMP go sign */
 | 
						|
	mov	r0, #0
 | 
						|
	ldr	r1, =SMP_MBOX_FIELD_GOSIGN
 | 
						|
	str	r0, [r1]
 | 
						|
 | 
						|
	/* notify cpuN mailbox is ready */
 | 
						|
	movw	r0, #0xCAFE
 | 
						|
	movt	r0, #0xBABE
 | 
						|
	ldr	r1, =SMP_MBOX_FIELD_READY
 | 
						|
	str	r0, [r1]
 | 
						|
	sev
 | 
						|
 | 
						|
	/* back to arch calling code */
 | 
						|
	mov	pc, lr
 | 
						|
 | 
						|
/*
 | 
						|
 * insn. inside mailbox to poll SMP go signal.
 | 
						|
 *
 | 
						|
 * Note that as this code will be relocated, any
 | 
						|
 * pc-relative assembly should NOT be used.
 | 
						|
 */
 | 
						|
mailbox_insn:
 | 
						|
	/*
 | 
						|
	 * r0 ~ r3 are parameters:
 | 
						|
	 *  r0 = SMP_MBOX_FIELD_GOSIGN
 | 
						|
	 *  r1 = SMP_MBOX_FIELD_ENTRY
 | 
						|
	 *  r2 = per-cpu go sign value
 | 
						|
	 *  r3 = no used now
 | 
						|
	 */
 | 
						|
poll_mailbox_smp_go:
 | 
						|
	wfe
 | 
						|
	ldr	r4, [r0]
 | 
						|
	cmp	r2, r4
 | 
						|
	bne	poll_mailbox_smp_go
 | 
						|
 | 
						|
	/* SMP GO signal confirmed, release cpuN */
 | 
						|
	ldr	pc, [r1]
 | 
						|
 | 
						|
mailbox_insn_end:
 | 
						|
	/* should never reach */
 | 
						|
	b	.
 | 
						|
 | 
						|
#endif
 |