mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-17 07:28:51 +09:00
![Masahiro Yamada](/assets/img/avatar_default.png)
Each way must be unlocked to make it effective. Signed-off-by: Masahiro Yamada <yamada.masahiro@socionext.com>
157 lines
3.2 KiB
C
157 lines
3.2 KiB
C
/*
|
|
* Copyright (C) 2012-2015 Masahiro Yamada <yamada.masahiro@socionext.com>
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <linux/io.h>
|
|
#include <asm/armv7.h>
|
|
|
|
#include "ssc-regs.h"
|
|
|
|
#ifdef CONFIG_UNIPHIER_L2CACHE_ON
|
|
static void uniphier_cache_sync(void)
|
|
{
|
|
writel(SSCOPE_CM_SYNC, SSCOPE); /* drain internal buffers */
|
|
readl(SSCOPE); /* need a read back to confirm */
|
|
}
|
|
|
|
static void uniphier_cache_maint_all(u32 operation)
|
|
{
|
|
/* try until the command is successfully set */
|
|
do {
|
|
writel(SSCOQM_S_ALL | SSCOQM_CE | operation, SSCOQM);
|
|
} while (readl(SSCOPPQSEF) & (SSCOPPQSEF_FE | SSCOPPQSEF_OE));
|
|
|
|
/* wait until the operation is completed */
|
|
while (readl(SSCOLPQS) != SSCOLPQS_EF)
|
|
;
|
|
|
|
/* clear the complete notification flag */
|
|
writel(SSCOLPQS_EF, SSCOLPQS);
|
|
|
|
uniphier_cache_sync();
|
|
}
|
|
|
|
void v7_outer_cache_flush_all(void)
|
|
{
|
|
uniphier_cache_maint_all(SSCOQM_CM_WB_INV);
|
|
}
|
|
|
|
void v7_outer_cache_inval_all(void)
|
|
{
|
|
uniphier_cache_maint_all(SSCOQM_CM_INV);
|
|
}
|
|
|
|
static void __uniphier_cache_maint_range(u32 start, u32 size, u32 operation)
|
|
{
|
|
/* try until the command is successfully set */
|
|
do {
|
|
writel(SSCOQM_S_ADDRESS | SSCOQM_CE | operation, SSCOQM);
|
|
writel(start, SSCOQAD);
|
|
writel(size, SSCOQSZ);
|
|
|
|
} while (readl(SSCOPPQSEF) & (SSCOPPQSEF_FE | SSCOPPQSEF_OE));
|
|
|
|
/* wait until the operation is completed */
|
|
while (readl(SSCOLPQS) != SSCOLPQS_EF)
|
|
;
|
|
|
|
/* clear the complete notification flag */
|
|
writel(SSCOLPQS_EF, SSCOLPQS);
|
|
}
|
|
|
|
static void uniphier_cache_maint_range(u32 start, u32 end, u32 operation)
|
|
{
|
|
u32 size;
|
|
|
|
/*
|
|
* If start address is not aligned to cache-line,
|
|
* do cache operation for the first cache-line
|
|
*/
|
|
start = start & ~(SSC_LINE_SIZE - 1);
|
|
|
|
size = end - start;
|
|
|
|
if (unlikely(size >= (u32)(-SSC_LINE_SIZE))) {
|
|
/* this means cache operation for all range */
|
|
uniphier_cache_maint_all(operation);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* If end address is not aligned to cache-line,
|
|
* do cache operation for the last cache-line
|
|
*/
|
|
size = ALIGN(size, SSC_LINE_SIZE);
|
|
|
|
while (size) {
|
|
u32 chunk_size = size > SSC_RANGE_OP_MAX_SIZE ?
|
|
SSC_RANGE_OP_MAX_SIZE : size;
|
|
__uniphier_cache_maint_range(start, chunk_size, operation);
|
|
|
|
start += chunk_size;
|
|
size -= chunk_size;
|
|
}
|
|
|
|
uniphier_cache_sync();
|
|
}
|
|
|
|
void v7_outer_cache_flush_range(u32 start, u32 end)
|
|
{
|
|
uniphier_cache_maint_range(start, end, SSCOQM_CM_WB_INV);
|
|
}
|
|
|
|
void v7_outer_cache_inval_range(u32 start, u32 end)
|
|
{
|
|
if (start & (SSC_LINE_SIZE - 1)) {
|
|
start &= ~(SSC_LINE_SIZE - 1);
|
|
__uniphier_cache_maint_range(start, SSC_LINE_SIZE,
|
|
SSCOQM_CM_WB_INV);
|
|
start += SSC_LINE_SIZE;
|
|
}
|
|
|
|
if (start >= end) {
|
|
uniphier_cache_sync();
|
|
return;
|
|
}
|
|
|
|
if (end & (SSC_LINE_SIZE - 1)) {
|
|
end &= ~(SSC_LINE_SIZE - 1);
|
|
__uniphier_cache_maint_range(end, SSC_LINE_SIZE,
|
|
SSCOQM_CM_WB_INV);
|
|
}
|
|
|
|
if (start >= end) {
|
|
uniphier_cache_sync();
|
|
return;
|
|
}
|
|
|
|
uniphier_cache_maint_range(start, end, SSCOQM_CM_INV);
|
|
}
|
|
|
|
void v7_outer_cache_enable(void)
|
|
{
|
|
u32 tmp;
|
|
|
|
writel(U32_MAX, SSCLPDAWCR); /* activate all ways */
|
|
tmp = readl(SSCC);
|
|
tmp |= SSCC_ON;
|
|
writel(tmp, SSCC);
|
|
}
|
|
#endif
|
|
|
|
void v7_outer_cache_disable(void)
|
|
{
|
|
u32 tmp;
|
|
tmp = readl(SSCC);
|
|
tmp &= ~SSCC_ON;
|
|
writel(tmp, SSCC);
|
|
}
|
|
|
|
void enable_caches(void)
|
|
{
|
|
dcache_enable();
|
|
}
|