forked from OERV-BSP/u-boot
riscv: cpu: th1520: Add a routine to bring up secondary cores
On coldboot, only HART 0 among the four HARTs of TH1520 is brought up by hardware, and the remaining HARTs are in reset states, requiring manual setup of reset address and deassertion to function normal. Introduce a routine to do the work. Signed-off-by: Yao Zi <ziyao@disroot.org> Reviewed-by: Leo Yu-Chi Liang <ycliang@andestech.com>
This commit is contained in:
@@ -9,8 +9,35 @@
|
||||
|
||||
#include <asm/io.h>
|
||||
#include <cpu_func.h>
|
||||
#include <linux/bitops.h>
|
||||
|
||||
#define TH1520_PMP_BASE (void *)0xffdc020000
|
||||
#define TH1520_C910_RST (void __iomem *)(0xffef014000 + 0x004)
|
||||
#define TH1520_C910_CORE_RST_N(n) BIT((n) + 1)
|
||||
#define TH1520_SYSCFG_AP_BASE (void __iomem *)(0xffef018000)
|
||||
#define TH1520_SYSCFG_CORE_START_L(n) (TH1520_SYSCFG_AP_BASE + 0x50 + 8 * (n))
|
||||
#define TH1520_SYSCFG_CORE_START_H(n) (TH1520_SYSCFG_AP_BASE + 0x54 + 8 * (n))
|
||||
#define TH1520_PMP_BASE (void *)0xffdc020000
|
||||
|
||||
void th1520_kick_secondary_cores(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
/*
|
||||
* On coldboot, only HART 0 is brought up by hardware, and resets for
|
||||
* secondary cores are asserted. Set reset address of secondary cores
|
||||
* to the entry of SPL, then deassert the resets to bring them up.
|
||||
*/
|
||||
for (i = 1; i < 4; i++) {
|
||||
writel(CONFIG_SPL_TEXT_BASE & 0xffffffff,
|
||||
TH1520_SYSCFG_CORE_START_L(i));
|
||||
writel(CONFIG_SPL_TEXT_BASE >> 32,
|
||||
TH1520_SYSCFG_CORE_START_H(i));
|
||||
}
|
||||
|
||||
setbits_le32(TH1520_C910_RST, TH1520_C910_CORE_RST_N(1) |
|
||||
TH1520_C910_CORE_RST_N(2) |
|
||||
TH1520_C910_CORE_RST_N(3));
|
||||
}
|
||||
|
||||
void th1520_invalidate_pmp(void)
|
||||
{
|
||||
|
||||
@@ -5,5 +5,6 @@
|
||||
|
||||
#ifndef _ASM_TH1520_CPU_H_
|
||||
#define _ASM_TH1520_CPU_H_
|
||||
void th1520_kick_secondary_cores(void);
|
||||
void th1520_invalidate_pmp(void);
|
||||
#endif /* _ASM_TH1520_CPU_H_ */
|
||||
|
||||
Reference in New Issue
Block a user