mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-26 04:53:42 +00:00
aa6e94deab
The rest of the unmigrated CONFIG symbols in the CONFIG_SYS_SDRAM namespace do not easily transition to Kconfig. In many cases they likely should come from the device tree instead. Move these out of CONFIG namespace and in to CFG namespace. Signed-off-by: Tom Rini <trini@konsulko.com> Reviewed-by: Simon Glass <sjg@chromium.org>
836 lines
21 KiB
C
836 lines
21 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2013-2014 Synopsys, Inc. All rights reserved.
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <cpu_func.h>
|
|
#include <asm/global_data.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/compiler.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/log2.h>
|
|
#include <lmb.h>
|
|
#include <asm/arcregs.h>
|
|
#include <asm/arc-bcr.h>
|
|
#include <asm/cache.h>
|
|
|
|
/*
|
|
* [ NOTE 1 ]:
|
|
* Data cache (L1 D$ or SL$) entire invalidate operation or data cache disable
|
|
* operation may result in unexpected behavior and data loss even if we flush
|
|
* data cache right before invalidation. That may happens if we store any context
|
|
* on stack (like we store BLINK register on stack before function call).
|
|
* BLINK register is the register where return address is automatically saved
|
|
* when we do function call with instructions like 'bl'.
|
|
*
|
|
* There is the real example:
|
|
* We may hang in the next code as we store any BLINK register on stack in
|
|
* invalidate_dcache_all() function.
|
|
*
|
|
* void flush_dcache_all() {
|
|
* __dc_entire_op(OP_FLUSH);
|
|
* // Other code //
|
|
* }
|
|
*
|
|
* void invalidate_dcache_all() {
|
|
* __dc_entire_op(OP_INV);
|
|
* // Other code //
|
|
* }
|
|
*
|
|
* void foo(void) {
|
|
* flush_dcache_all();
|
|
* invalidate_dcache_all();
|
|
* }
|
|
*
|
|
* Now let's see what really happens during that code execution:
|
|
*
|
|
* foo()
|
|
* |->> call flush_dcache_all
|
|
* [return address is saved to BLINK register]
|
|
* [push BLINK] (save to stack) ![point 1]
|
|
* |->> call __dc_entire_op(OP_FLUSH)
|
|
* [return address is saved to BLINK register]
|
|
* [flush L1 D$]
|
|
* return [jump to BLINK]
|
|
* <<------
|
|
* [other flush_dcache_all code]
|
|
* [pop BLINK] (get from stack)
|
|
* return [jump to BLINK]
|
|
* <<------
|
|
* |->> call invalidate_dcache_all
|
|
* [return address is saved to BLINK register]
|
|
* [push BLINK] (save to stack) ![point 2]
|
|
* |->> call __dc_entire_op(OP_FLUSH)
|
|
* [return address is saved to BLINK register]
|
|
* [invalidate L1 D$] ![point 3]
|
|
* // Oops!!!
|
|
* // We lose return address from invalidate_dcache_all function:
|
|
* // we save it to stack and invalidate L1 D$ after that!
|
|
* return [jump to BLINK]
|
|
* <<------
|
|
* [other invalidate_dcache_all code]
|
|
* [pop BLINK] (get from stack)
|
|
* // we don't have this data in L1 dcache as we invalidated it in [point 3]
|
|
* // so we get it from next memory level (for example DDR memory)
|
|
* // but in the memory we have value which we save in [point 1], which
|
|
* // is return address from flush_dcache_all function (instead of
|
|
* // address from current invalidate_dcache_all function which we
|
|
* // saved in [point 2] !)
|
|
* return [jump to BLINK]
|
|
* <<------
|
|
* // As BLINK points to invalidate_dcache_all, we call it again and
|
|
* // loop forever.
|
|
*
|
|
* Fortunately we may fix that by using flush & invalidation of D$ with a single
|
|
* one instruction (instead of flush and invalidation instructions pair) and
|
|
* enabling force function inline with '__attribute__((always_inline))' gcc
|
|
* attribute to avoid any function call (and BLINK store) between cache flush
|
|
* and disable.
|
|
*
|
|
*
|
|
* [ NOTE 2 ]:
|
|
* As of today we only support the following cache configurations on ARC.
|
|
* Other configurations may exist in HW but we don't support it in SW.
|
|
* Configuration 1:
|
|
* ______________________
|
|
* | |
|
|
* | ARC CPU |
|
|
* |______________________|
|
|
* ___|___ ___|___
|
|
* | | | |
|
|
* | L1 I$ | | L1 D$ |
|
|
* |_______| |_______|
|
|
* on/off on/off
|
|
* ___|______________|____
|
|
* | |
|
|
* | main memory |
|
|
* |______________________|
|
|
*
|
|
* Configuration 2:
|
|
* ______________________
|
|
* | |
|
|
* | ARC CPU |
|
|
* |______________________|
|
|
* ___|___ ___|___
|
|
* | | | |
|
|
* | L1 I$ | | L1 D$ |
|
|
* |_______| |_______|
|
|
* on/off on/off
|
|
* ___|______________|____
|
|
* | |
|
|
* | L2 (SL$) |
|
|
* |______________________|
|
|
* always on (ARCv2, HS < 3.0)
|
|
* on/off (ARCv2, HS >= 3.0)
|
|
* ___|______________|____
|
|
* | |
|
|
* | main memory |
|
|
* |______________________|
|
|
*
|
|
* Configuration 3:
|
|
* ______________________
|
|
* | |
|
|
* | ARC CPU |
|
|
* |______________________|
|
|
* ___|___ ___|___
|
|
* | | | |
|
|
* | L1 I$ | | L1 D$ |
|
|
* |_______| |_______|
|
|
* on/off must be on
|
|
* ___|______________|____ _______
|
|
* | | | |
|
|
* | L2 (SL$) |-----| IOC |
|
|
* |______________________| |_______|
|
|
* always must be on on/off
|
|
* ___|______________|____
|
|
* | |
|
|
* | main memory |
|
|
* |______________________|
|
|
*/
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
/* Bit values in IC_CTRL */
|
|
#define IC_CTRL_CACHE_DISABLE BIT(0)
|
|
|
|
/* Bit values in DC_CTRL */
|
|
#define DC_CTRL_CACHE_DISABLE BIT(0)
|
|
#define DC_CTRL_INV_MODE_FLUSH BIT(6)
|
|
#define DC_CTRL_FLUSH_STATUS BIT(8)
|
|
|
|
#define OP_INV BIT(0)
|
|
#define OP_FLUSH BIT(1)
|
|
#define OP_FLUSH_N_INV (OP_FLUSH | OP_INV)
|
|
|
|
/* Bit val in SLC_CONTROL */
|
|
#define SLC_CTRL_DIS 0x001
|
|
#define SLC_CTRL_IM 0x040
|
|
#define SLC_CTRL_BUSY 0x100
|
|
#define SLC_CTRL_RGN_OP_INV 0x200
|
|
|
|
#define CACHE_LINE_MASK (~(gd->arch.l1_line_sz - 1))
|
|
|
|
/*
|
|
* We don't want to use '__always_inline' macro here as it can be redefined
|
|
* to simple 'inline' in some cases which breaks stuff. See [ NOTE 1 ] for more
|
|
* details about the reasons we need to use always_inline functions.
|
|
*/
|
|
#define inlined_cachefunc inline __attribute__((always_inline))
|
|
|
|
static inlined_cachefunc void __ic_entire_invalidate(void);
|
|
static inlined_cachefunc void __dc_entire_op(const int cacheop);
|
|
static inlined_cachefunc void __slc_entire_op(const int op);
|
|
static inlined_cachefunc bool ioc_enabled(void);
|
|
|
|
static inline bool pae_exists(void)
|
|
{
|
|
/* TODO: should we compare mmu version from BCR and from CONFIG? */
|
|
#if (CONFIG_ARC_MMU_VER >= 4)
|
|
union bcr_mmu_4 mmu4;
|
|
|
|
mmu4.word = read_aux_reg(ARC_AUX_MMU_BCR);
|
|
|
|
if (mmu4.fields.pae)
|
|
return true;
|
|
#endif /* (CONFIG_ARC_MMU_VER >= 4) */
|
|
|
|
return false;
|
|
}
|
|
|
|
static inlined_cachefunc bool icache_exists(void)
|
|
{
|
|
union bcr_di_cache ibcr;
|
|
|
|
ibcr.word = read_aux_reg(ARC_BCR_IC_BUILD);
|
|
return !!ibcr.fields.ver;
|
|
}
|
|
|
|
static inlined_cachefunc bool icache_enabled(void)
|
|
{
|
|
if (!icache_exists())
|
|
return false;
|
|
|
|
return !(read_aux_reg(ARC_AUX_IC_CTRL) & IC_CTRL_CACHE_DISABLE);
|
|
}
|
|
|
|
static inlined_cachefunc bool dcache_exists(void)
|
|
{
|
|
union bcr_di_cache dbcr;
|
|
|
|
dbcr.word = read_aux_reg(ARC_BCR_DC_BUILD);
|
|
return !!dbcr.fields.ver;
|
|
}
|
|
|
|
static inlined_cachefunc bool dcache_enabled(void)
|
|
{
|
|
if (!dcache_exists())
|
|
return false;
|
|
|
|
return !(read_aux_reg(ARC_AUX_DC_CTRL) & DC_CTRL_CACHE_DISABLE);
|
|
}
|
|
|
|
static inlined_cachefunc bool slc_exists(void)
|
|
{
|
|
if (is_isa_arcv2()) {
|
|
union bcr_generic sbcr;
|
|
|
|
sbcr.word = read_aux_reg(ARC_BCR_SLC);
|
|
return !!sbcr.fields.ver;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
enum slc_dis_status {
|
|
ST_SLC_MISSING = 0,
|
|
ST_SLC_NO_DISABLE_CTRL,
|
|
ST_SLC_DISABLE_CTRL
|
|
};
|
|
|
|
/*
|
|
* ARCv1 -> ST_SLC_MISSING
|
|
* ARCv2 && SLC absent -> ST_SLC_MISSING
|
|
* ARCv2 && SLC exists && SLC version <= 2 -> ST_SLC_NO_DISABLE_CTRL
|
|
* ARCv2 && SLC exists && SLC version > 2 -> ST_SLC_DISABLE_CTRL
|
|
*/
|
|
static inlined_cachefunc enum slc_dis_status slc_disable_supported(void)
|
|
{
|
|
if (is_isa_arcv2()) {
|
|
union bcr_generic sbcr;
|
|
|
|
sbcr.word = read_aux_reg(ARC_BCR_SLC);
|
|
if (sbcr.fields.ver == 0)
|
|
return ST_SLC_MISSING;
|
|
else if (sbcr.fields.ver <= 2)
|
|
return ST_SLC_NO_DISABLE_CTRL;
|
|
else
|
|
return ST_SLC_DISABLE_CTRL;
|
|
}
|
|
|
|
return ST_SLC_MISSING;
|
|
}
|
|
|
|
static inlined_cachefunc bool __slc_enabled(void)
|
|
{
|
|
return !(read_aux_reg(ARC_AUX_SLC_CTRL) & SLC_CTRL_DIS);
|
|
}
|
|
|
|
static inlined_cachefunc void __slc_enable(void)
|
|
{
|
|
unsigned int ctrl;
|
|
|
|
ctrl = read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
ctrl &= ~SLC_CTRL_DIS;
|
|
write_aux_reg(ARC_AUX_SLC_CTRL, ctrl);
|
|
}
|
|
|
|
static inlined_cachefunc void __slc_disable(void)
|
|
{
|
|
unsigned int ctrl;
|
|
|
|
ctrl = read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
ctrl |= SLC_CTRL_DIS;
|
|
write_aux_reg(ARC_AUX_SLC_CTRL, ctrl);
|
|
}
|
|
|
|
static inlined_cachefunc bool slc_enabled(void)
|
|
{
|
|
enum slc_dis_status slc_status = slc_disable_supported();
|
|
|
|
if (slc_status == ST_SLC_MISSING)
|
|
return false;
|
|
else if (slc_status == ST_SLC_NO_DISABLE_CTRL)
|
|
return true;
|
|
else
|
|
return __slc_enabled();
|
|
}
|
|
|
|
static inlined_cachefunc bool slc_data_bypass(void)
|
|
{
|
|
/*
|
|
* If L1 data cache is disabled SL$ is bypassed and all load/store
|
|
* requests are sent directly to main memory.
|
|
*/
|
|
return !dcache_enabled();
|
|
}
|
|
|
|
void slc_enable(void)
|
|
{
|
|
if (slc_disable_supported() != ST_SLC_DISABLE_CTRL)
|
|
return;
|
|
|
|
if (__slc_enabled())
|
|
return;
|
|
|
|
__slc_enable();
|
|
}
|
|
|
|
/* TODO: warn if we are not able to disable SLC */
|
|
void slc_disable(void)
|
|
{
|
|
if (slc_disable_supported() != ST_SLC_DISABLE_CTRL)
|
|
return;
|
|
|
|
/* we don't support SLC disabling if we use IOC */
|
|
if (ioc_enabled())
|
|
return;
|
|
|
|
if (!__slc_enabled())
|
|
return;
|
|
|
|
/*
|
|
* We need to flush L1D$ to guarantee that we won't have any
|
|
* writeback operations during SLC disabling.
|
|
*/
|
|
__dc_entire_op(OP_FLUSH);
|
|
__slc_entire_op(OP_FLUSH_N_INV);
|
|
__slc_disable();
|
|
}
|
|
|
|
static inlined_cachefunc bool ioc_exists(void)
|
|
{
|
|
if (is_isa_arcv2()) {
|
|
union bcr_clust_cfg cbcr;
|
|
|
|
cbcr.word = read_aux_reg(ARC_BCR_CLUSTER);
|
|
return cbcr.fields.c;
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static inlined_cachefunc bool ioc_enabled(void)
|
|
{
|
|
/*
|
|
* We check only CONFIG option instead of IOC HW state check as IOC
|
|
* must be disabled by default.
|
|
*/
|
|
if (is_ioc_enabled())
|
|
return ioc_exists();
|
|
|
|
return false;
|
|
}
|
|
|
|
static inlined_cachefunc void __slc_entire_op(const int op)
|
|
{
|
|
unsigned int ctrl;
|
|
|
|
if (!slc_enabled())
|
|
return;
|
|
|
|
ctrl = read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
|
|
if (!(op & OP_FLUSH)) /* i.e. OP_INV */
|
|
ctrl &= ~SLC_CTRL_IM; /* clear IM: Disable flush before Inv */
|
|
else
|
|
ctrl |= SLC_CTRL_IM;
|
|
|
|
write_aux_reg(ARC_AUX_SLC_CTRL, ctrl);
|
|
|
|
if (op & OP_INV) /* Inv or flush-n-inv use same cmd reg */
|
|
write_aux_reg(ARC_AUX_SLC_INVALIDATE, 0x1);
|
|
else
|
|
write_aux_reg(ARC_AUX_SLC_FLUSH, 0x1);
|
|
|
|
/* Make sure "busy" bit reports correct stataus, see STAR 9001165532 */
|
|
read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
|
|
/* Important to wait for flush to complete */
|
|
while (read_aux_reg(ARC_AUX_SLC_CTRL) & SLC_CTRL_BUSY);
|
|
}
|
|
|
|
static void slc_upper_region_init(void)
|
|
{
|
|
/*
|
|
* ARC_AUX_SLC_RGN_START1 and ARC_AUX_SLC_RGN_END1 register exist
|
|
* only if PAE exists in current HW. So we had to check pae_exist
|
|
* before using them.
|
|
*/
|
|
if (!pae_exists())
|
|
return;
|
|
|
|
/*
|
|
* ARC_AUX_SLC_RGN_END1 and ARC_AUX_SLC_RGN_START1 are always == 0
|
|
* as we don't use PAE40.
|
|
*/
|
|
write_aux_reg(ARC_AUX_SLC_RGN_END1, 0);
|
|
write_aux_reg(ARC_AUX_SLC_RGN_START1, 0);
|
|
}
|
|
|
|
static void __slc_rgn_op(unsigned long paddr, unsigned long sz, const int op)
|
|
{
|
|
#ifdef CONFIG_ISA_ARCV2
|
|
|
|
unsigned int ctrl;
|
|
unsigned long end;
|
|
|
|
if (!slc_enabled())
|
|
return;
|
|
|
|
/*
|
|
* The Region Flush operation is specified by CTRL.RGN_OP[11..9]
|
|
* - b'000 (default) is Flush,
|
|
* - b'001 is Invalidate if CTRL.IM == 0
|
|
* - b'001 is Flush-n-Invalidate if CTRL.IM == 1
|
|
*/
|
|
ctrl = read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
|
|
/* Don't rely on default value of IM bit */
|
|
if (!(op & OP_FLUSH)) /* i.e. OP_INV */
|
|
ctrl &= ~SLC_CTRL_IM; /* clear IM: Disable flush before Inv */
|
|
else
|
|
ctrl |= SLC_CTRL_IM;
|
|
|
|
if (op & OP_INV)
|
|
ctrl |= SLC_CTRL_RGN_OP_INV; /* Inv or flush-n-inv */
|
|
else
|
|
ctrl &= ~SLC_CTRL_RGN_OP_INV;
|
|
|
|
write_aux_reg(ARC_AUX_SLC_CTRL, ctrl);
|
|
|
|
/*
|
|
* Lower bits are ignored, no need to clip
|
|
* END needs to be setup before START (latter triggers the operation)
|
|
* END can't be same as START, so add (l2_line_sz - 1) to sz
|
|
*/
|
|
end = paddr + sz + gd->arch.slc_line_sz - 1;
|
|
|
|
/*
|
|
* Upper addresses (ARC_AUX_SLC_RGN_END1 and ARC_AUX_SLC_RGN_START1)
|
|
* are always == 0 as we don't use PAE40, so we only setup lower ones
|
|
* (ARC_AUX_SLC_RGN_END and ARC_AUX_SLC_RGN_START)
|
|
*/
|
|
write_aux_reg(ARC_AUX_SLC_RGN_END, end);
|
|
write_aux_reg(ARC_AUX_SLC_RGN_START, paddr);
|
|
|
|
/* Make sure "busy" bit reports correct stataus, see STAR 9001165532 */
|
|
read_aux_reg(ARC_AUX_SLC_CTRL);
|
|
|
|
while (read_aux_reg(ARC_AUX_SLC_CTRL) & SLC_CTRL_BUSY);
|
|
|
|
#endif /* CONFIG_ISA_ARCV2 */
|
|
}
|
|
|
|
static void arc_ioc_setup(void)
|
|
{
|
|
/* IOC Aperture start is equal to DDR start */
|
|
unsigned int ap_base = CFG_SYS_SDRAM_BASE;
|
|
/* IOC Aperture size is equal to DDR size */
|
|
long ap_size = CFG_SYS_SDRAM_SIZE;
|
|
|
|
/* Unsupported configuration. See [ NOTE 2 ] for more details. */
|
|
if (!slc_exists())
|
|
panic("Try to enable IOC but SLC is not present");
|
|
|
|
if (!slc_enabled())
|
|
panic("Try to enable IOC but SLC is disabled");
|
|
|
|
/* Unsupported configuration. See [ NOTE 2 ] for more details. */
|
|
if (!dcache_enabled())
|
|
panic("Try to enable IOC but L1 D$ is disabled");
|
|
|
|
if (!is_power_of_2(ap_size) || ap_size < 4096)
|
|
panic("IOC Aperture size must be power of 2 and bigger 4Kib");
|
|
|
|
/* IOC Aperture start must be aligned to the size of the aperture */
|
|
if (ap_base % ap_size != 0)
|
|
panic("IOC Aperture start must be aligned to the size of the aperture");
|
|
|
|
flush_n_invalidate_dcache_all();
|
|
|
|
/*
|
|
* IOC Aperture size decoded as 2 ^ (SIZE + 2) KB,
|
|
* so setting 0x11 implies 512M, 0x12 implies 1G...
|
|
*/
|
|
write_aux_reg(ARC_AUX_IO_COH_AP0_SIZE,
|
|
order_base_2(ap_size / 1024) - 2);
|
|
|
|
write_aux_reg(ARC_AUX_IO_COH_AP0_BASE, ap_base >> 12);
|
|
write_aux_reg(ARC_AUX_IO_COH_PARTIAL, 1);
|
|
write_aux_reg(ARC_AUX_IO_COH_ENABLE, 1);
|
|
}
|
|
|
|
static void read_decode_cache_bcr_arcv2(void)
|
|
{
|
|
#ifdef CONFIG_ISA_ARCV2
|
|
|
|
union bcr_slc_cfg slc_cfg;
|
|
|
|
if (slc_exists()) {
|
|
slc_cfg.word = read_aux_reg(ARC_AUX_SLC_CONFIG);
|
|
gd->arch.slc_line_sz = (slc_cfg.fields.lsz == 0) ? 128 : 64;
|
|
|
|
/*
|
|
* We don't support configuration where L1 I$ or L1 D$ is
|
|
* absent but SL$ exists. See [ NOTE 2 ] for more details.
|
|
*/
|
|
if (!icache_exists() || !dcache_exists())
|
|
panic("Unsupported cache configuration: SLC exists but one of L1 caches is absent");
|
|
}
|
|
|
|
#endif /* CONFIG_ISA_ARCV2 */
|
|
}
|
|
|
|
void read_decode_cache_bcr(void)
|
|
{
|
|
int dc_line_sz = 0, ic_line_sz = 0;
|
|
union bcr_di_cache ibcr, dbcr;
|
|
|
|
/*
|
|
* We don't care much about I$ line length really as there're
|
|
* no per-line ops on I$ instead we only do full invalidation of it
|
|
* on occasion of relocation and right before jumping to the OS.
|
|
* Still we check insane config with zero-encoded line length in
|
|
* presense of version field in I$ BCR. Just in case.
|
|
*/
|
|
ibcr.word = read_aux_reg(ARC_BCR_IC_BUILD);
|
|
if (ibcr.fields.ver) {
|
|
ic_line_sz = 8 << ibcr.fields.line_len;
|
|
if (!ic_line_sz)
|
|
panic("Instruction exists but line length is 0\n");
|
|
}
|
|
|
|
dbcr.word = read_aux_reg(ARC_BCR_DC_BUILD);
|
|
if (dbcr.fields.ver) {
|
|
gd->arch.l1_line_sz = dc_line_sz = 16 << dbcr.fields.line_len;
|
|
if (!dc_line_sz)
|
|
panic("Data cache exists but line length is 0\n");
|
|
}
|
|
}
|
|
|
|
void cache_init(void)
|
|
{
|
|
read_decode_cache_bcr();
|
|
|
|
if (is_isa_arcv2())
|
|
read_decode_cache_bcr_arcv2();
|
|
|
|
if (is_isa_arcv2() && ioc_enabled())
|
|
arc_ioc_setup();
|
|
|
|
if (is_isa_arcv2() && slc_exists())
|
|
slc_upper_region_init();
|
|
}
|
|
|
|
int icache_status(void)
|
|
{
|
|
return icache_enabled();
|
|
}
|
|
|
|
void icache_enable(void)
|
|
{
|
|
if (icache_exists())
|
|
write_aux_reg(ARC_AUX_IC_CTRL, read_aux_reg(ARC_AUX_IC_CTRL) &
|
|
~IC_CTRL_CACHE_DISABLE);
|
|
}
|
|
|
|
void icache_disable(void)
|
|
{
|
|
if (!icache_exists())
|
|
return;
|
|
|
|
__ic_entire_invalidate();
|
|
|
|
write_aux_reg(ARC_AUX_IC_CTRL, read_aux_reg(ARC_AUX_IC_CTRL) |
|
|
IC_CTRL_CACHE_DISABLE);
|
|
}
|
|
|
|
/* IC supports only invalidation */
|
|
static inlined_cachefunc void __ic_entire_invalidate(void)
|
|
{
|
|
if (!icache_enabled())
|
|
return;
|
|
|
|
/* Any write to IC_IVIC register triggers invalidation of entire I$ */
|
|
write_aux_reg(ARC_AUX_IC_IVIC, 1);
|
|
/*
|
|
* As per ARC HS databook (see chapter 5.3.3.2)
|
|
* it is required to add 3 NOPs after each write to IC_IVIC.
|
|
*/
|
|
__builtin_arc_nop();
|
|
__builtin_arc_nop();
|
|
__builtin_arc_nop();
|
|
read_aux_reg(ARC_AUX_IC_CTRL); /* blocks */
|
|
}
|
|
|
|
void invalidate_icache_all(void)
|
|
{
|
|
__ic_entire_invalidate();
|
|
|
|
/*
|
|
* If SL$ is bypassed for data it is used only for instructions,
|
|
* so we need to invalidate it too.
|
|
*/
|
|
if (is_isa_arcv2() && slc_data_bypass())
|
|
__slc_entire_op(OP_INV);
|
|
}
|
|
|
|
int dcache_status(void)
|
|
{
|
|
return dcache_enabled();
|
|
}
|
|
|
|
void dcache_enable(void)
|
|
{
|
|
if (!dcache_exists())
|
|
return;
|
|
|
|
write_aux_reg(ARC_AUX_DC_CTRL, read_aux_reg(ARC_AUX_DC_CTRL) &
|
|
~(DC_CTRL_INV_MODE_FLUSH | DC_CTRL_CACHE_DISABLE));
|
|
}
|
|
|
|
void dcache_disable(void)
|
|
{
|
|
if (!dcache_exists())
|
|
return;
|
|
|
|
__dc_entire_op(OP_FLUSH_N_INV);
|
|
|
|
/*
|
|
* As SLC will be bypassed for data after L1 D$ disable we need to
|
|
* flush it first before L1 D$ disable. Also we invalidate SLC to
|
|
* avoid any inconsistent data problems after enabling L1 D$ again with
|
|
* dcache_enable function.
|
|
*/
|
|
if (is_isa_arcv2())
|
|
__slc_entire_op(OP_FLUSH_N_INV);
|
|
|
|
write_aux_reg(ARC_AUX_DC_CTRL, read_aux_reg(ARC_AUX_DC_CTRL) |
|
|
DC_CTRL_CACHE_DISABLE);
|
|
}
|
|
|
|
/* Common Helper for Line Operations on D-cache */
|
|
static inline void __dcache_line_loop(unsigned long paddr, unsigned long sz,
|
|
const int cacheop)
|
|
{
|
|
unsigned int aux_cmd;
|
|
int num_lines;
|
|
|
|
/* d$ cmd: INV (discard or wback-n-discard) OR FLUSH (wback) */
|
|
aux_cmd = cacheop & OP_INV ? ARC_AUX_DC_IVDL : ARC_AUX_DC_FLDL;
|
|
|
|
sz += paddr & ~CACHE_LINE_MASK;
|
|
paddr &= CACHE_LINE_MASK;
|
|
|
|
num_lines = DIV_ROUND_UP(sz, gd->arch.l1_line_sz);
|
|
|
|
while (num_lines-- > 0) {
|
|
#if (CONFIG_ARC_MMU_VER == 3)
|
|
write_aux_reg(ARC_AUX_DC_PTAG, paddr);
|
|
#endif
|
|
write_aux_reg(aux_cmd, paddr);
|
|
paddr += gd->arch.l1_line_sz;
|
|
}
|
|
}
|
|
|
|
static inlined_cachefunc void __before_dc_op(const int op)
|
|
{
|
|
unsigned int ctrl;
|
|
|
|
ctrl = read_aux_reg(ARC_AUX_DC_CTRL);
|
|
|
|
/* IM bit implies flush-n-inv, instead of vanilla inv */
|
|
if (op == OP_INV)
|
|
ctrl &= ~DC_CTRL_INV_MODE_FLUSH;
|
|
else
|
|
ctrl |= DC_CTRL_INV_MODE_FLUSH;
|
|
|
|
write_aux_reg(ARC_AUX_DC_CTRL, ctrl);
|
|
}
|
|
|
|
static inlined_cachefunc void __after_dc_op(const int op)
|
|
{
|
|
if (op & OP_FLUSH) /* flush / flush-n-inv both wait */
|
|
while (read_aux_reg(ARC_AUX_DC_CTRL) & DC_CTRL_FLUSH_STATUS);
|
|
}
|
|
|
|
static inlined_cachefunc void __dc_entire_op(const int cacheop)
|
|
{
|
|
int aux;
|
|
|
|
if (!dcache_enabled())
|
|
return;
|
|
|
|
__before_dc_op(cacheop);
|
|
|
|
if (cacheop & OP_INV) /* Inv or flush-n-inv use same cmd reg */
|
|
aux = ARC_AUX_DC_IVDC;
|
|
else
|
|
aux = ARC_AUX_DC_FLSH;
|
|
|
|
write_aux_reg(aux, 0x1);
|
|
|
|
__after_dc_op(cacheop);
|
|
}
|
|
|
|
static inline void __dc_line_op(unsigned long paddr, unsigned long sz,
|
|
const int cacheop)
|
|
{
|
|
if (!dcache_enabled())
|
|
return;
|
|
|
|
__before_dc_op(cacheop);
|
|
__dcache_line_loop(paddr, sz, cacheop);
|
|
__after_dc_op(cacheop);
|
|
}
|
|
|
|
void invalidate_dcache_range(unsigned long start, unsigned long end)
|
|
{
|
|
if (start >= end)
|
|
return;
|
|
|
|
/*
|
|
* ARCv1 -> call __dc_line_op
|
|
* ARCv2 && L1 D$ disabled -> nothing
|
|
* ARCv2 && L1 D$ enabled && IOC enabled -> nothing
|
|
* ARCv2 && L1 D$ enabled && no IOC -> call __dc_line_op; call __slc_rgn_op
|
|
*/
|
|
if (!is_isa_arcv2() || !ioc_enabled())
|
|
__dc_line_op(start, end - start, OP_INV);
|
|
|
|
if (is_isa_arcv2() && !ioc_enabled() && !slc_data_bypass())
|
|
__slc_rgn_op(start, end - start, OP_INV);
|
|
}
|
|
|
|
void flush_dcache_range(unsigned long start, unsigned long end)
|
|
{
|
|
if (start >= end)
|
|
return;
|
|
|
|
/*
|
|
* ARCv1 -> call __dc_line_op
|
|
* ARCv2 && L1 D$ disabled -> nothing
|
|
* ARCv2 && L1 D$ enabled && IOC enabled -> nothing
|
|
* ARCv2 && L1 D$ enabled && no IOC -> call __dc_line_op; call __slc_rgn_op
|
|
*/
|
|
if (!is_isa_arcv2() || !ioc_enabled())
|
|
__dc_line_op(start, end - start, OP_FLUSH);
|
|
|
|
if (is_isa_arcv2() && !ioc_enabled() && !slc_data_bypass())
|
|
__slc_rgn_op(start, end - start, OP_FLUSH);
|
|
}
|
|
|
|
void flush_cache(unsigned long start, unsigned long size)
|
|
{
|
|
flush_dcache_range(start, start + size);
|
|
}
|
|
|
|
/*
|
|
* As invalidate_dcache_all() is not used in generic U-Boot code and as we
|
|
* don't need it in arch/arc code alone (invalidate without flush) we implement
|
|
* flush_n_invalidate_dcache_all (flush and invalidate in 1 operation) because
|
|
* it's much safer. See [ NOTE 1 ] for more details.
|
|
*/
|
|
void flush_n_invalidate_dcache_all(void)
|
|
{
|
|
__dc_entire_op(OP_FLUSH_N_INV);
|
|
|
|
if (is_isa_arcv2() && !slc_data_bypass())
|
|
__slc_entire_op(OP_FLUSH_N_INV);
|
|
}
|
|
|
|
void flush_dcache_all(void)
|
|
{
|
|
__dc_entire_op(OP_FLUSH);
|
|
|
|
if (is_isa_arcv2() && !slc_data_bypass())
|
|
__slc_entire_op(OP_FLUSH);
|
|
}
|
|
|
|
/*
|
|
* This is function to cleanup all caches (and therefore sync I/D caches) which
|
|
* can be used for cleanup before linux launch or to sync caches during
|
|
* relocation.
|
|
*/
|
|
void sync_n_cleanup_cache_all(void)
|
|
{
|
|
__dc_entire_op(OP_FLUSH_N_INV);
|
|
|
|
/*
|
|
* If SL$ is bypassed for data it is used only for instructions,
|
|
* and we shouldn't flush it. So invalidate it instead of flush_n_inv.
|
|
*/
|
|
if (is_isa_arcv2()) {
|
|
if (slc_data_bypass())
|
|
__slc_entire_op(OP_INV);
|
|
else
|
|
__slc_entire_op(OP_FLUSH_N_INV);
|
|
}
|
|
|
|
__ic_entire_invalidate();
|
|
}
|
|
|
|
static ulong get_sp(void)
|
|
{
|
|
ulong ret;
|
|
|
|
asm("mov %0, sp" : "=r"(ret) : );
|
|
return ret;
|
|
}
|
|
|
|
void arch_lmb_reserve(struct lmb *lmb)
|
|
{
|
|
arch_lmb_reserve_generic(lmb, get_sp(), gd->ram_top, 4096);
|
|
}
|