mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-11 07:34:31 +00:00
riscv: ax25: cache: Add SPL_RISCV_MMODE for SPL
The mcache_ctl csr only can be manipulated in M mode. Add SPL_RISCV_MMODE for U-Boot SPL to control cache operation. Signed-off-by: Rick Chen <rick@andestech.com> Cc: KC Lin <kclin@andestech.com> Cc: Alan Kao <alankao@andestech.com>
This commit is contained in:
parent
43a0832ba0
commit
8ba595b6bd
1 changed files with 46 additions and 14 deletions
|
@ -12,18 +12,46 @@
|
|||
#include <asm/csr.h>
|
||||
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
/* mcctlcommand */
|
||||
#define CCTL_REG_MCCTLCOMMAND_NUM 0x7cc
|
||||
|
||||
/* D-cache operation */
|
||||
#define CCTL_L1D_WBINVAL_ALL 6
|
||||
#endif
|
||||
#endif
|
||||
|
||||
#ifdef CONFIG_V5L2_CACHE
|
||||
static void _cache_enable(void)
|
||||
{
|
||||
struct udevice *dev = NULL;
|
||||
|
||||
uclass_find_first_device(UCLASS_CACHE, &dev);
|
||||
|
||||
if (dev)
|
||||
cache_enable(dev);
|
||||
}
|
||||
|
||||
static void _cache_disable(void)
|
||||
{
|
||||
struct udevice *dev = NULL;
|
||||
|
||||
uclass_find_first_device(UCLASS_CACHE, &dev);
|
||||
|
||||
if (dev)
|
||||
cache_disable(dev);
|
||||
}
|
||||
#endif
|
||||
|
||||
void flush_dcache_all(void)
|
||||
{
|
||||
#if !CONFIG_IS_ENABLED(SYS_ICACHE_OFF)
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
csr_write(CCTL_REG_MCCTLCOMMAND_NUM, CCTL_L1D_WBINVAL_ALL);
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
||||
void flush_dcache_range(unsigned long start, unsigned long end)
|
||||
|
@ -40,6 +68,7 @@ void icache_enable(void)
|
|||
{
|
||||
#if !CONFIG_IS_ENABLED(SYS_ICACHE_OFF)
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
asm volatile (
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
"ori t0, t1, 0x1\n\t"
|
||||
|
@ -47,12 +76,14 @@ void icache_enable(void)
|
|||
);
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
||||
void icache_disable(void)
|
||||
{
|
||||
#if !CONFIG_IS_ENABLED(SYS_ICACHE_OFF)
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
asm volatile (
|
||||
"fence.i\n\t"
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
|
@ -61,24 +92,23 @@ void icache_disable(void)
|
|||
);
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
||||
void dcache_enable(void)
|
||||
{
|
||||
#if !CONFIG_IS_ENABLED(SYS_DCACHE_OFF)
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
struct udevice *dev = NULL;
|
||||
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
asm volatile (
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
"ori t0, t1, 0x2\n\t"
|
||||
"csrw mcache_ctl, t0\n\t"
|
||||
);
|
||||
|
||||
uclass_find_first_device(UCLASS_CACHE, &dev);
|
||||
|
||||
if (dev)
|
||||
cache_enable(dev);
|
||||
#endif
|
||||
#ifdef CONFIG_V5L2_CACHE
|
||||
_cache_enable();
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
@ -87,19 +117,17 @@ void dcache_disable(void)
|
|||
{
|
||||
#if !CONFIG_IS_ENABLED(SYS_DCACHE_OFF)
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
struct udevice *dev = NULL;
|
||||
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
csr_write(CCTL_REG_MCCTLCOMMAND_NUM, CCTL_L1D_WBINVAL_ALL);
|
||||
asm volatile (
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
"andi t0, t1, ~0x2\n\t"
|
||||
"csrw mcache_ctl, t0\n\t"
|
||||
);
|
||||
|
||||
uclass_find_first_device(UCLASS_CACHE, &dev);
|
||||
|
||||
if (dev)
|
||||
cache_disable(dev);
|
||||
#endif
|
||||
#ifdef CONFIG_V5L2_CACHE
|
||||
_cache_disable();
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
}
|
||||
|
@ -109,6 +137,7 @@ int icache_status(void)
|
|||
int ret = 0;
|
||||
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
asm volatile (
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
"andi %0, t1, 0x01\n\t"
|
||||
|
@ -116,6 +145,7 @@ int icache_status(void)
|
|||
:
|
||||
: "memory"
|
||||
);
|
||||
#endif
|
||||
#endif
|
||||
|
||||
return ret;
|
||||
|
@ -126,6 +156,7 @@ int dcache_status(void)
|
|||
int ret = 0;
|
||||
|
||||
#ifdef CONFIG_RISCV_NDS_CACHE
|
||||
#if CONFIG_IS_ENABLED(RISCV_MMODE) || CONFIG_IS_ENABLED(SPL_RISCV_MMODE)
|
||||
asm volatile (
|
||||
"csrr t1, mcache_ctl\n\t"
|
||||
"andi %0, t1, 0x02\n\t"
|
||||
|
@ -133,6 +164,7 @@ int dcache_status(void)
|
|||
:
|
||||
: "memory"
|
||||
);
|
||||
#endif
|
||||
#endif
|
||||
|
||||
return ret;
|
||||
|
|
Loading…
Reference in a new issue