94 lines
1.9 KiB
C
94 lines
1.9 KiB
C
|
#include "jz47xx.h"
|
||
|
|
#include "cache.h"
|
||
|
|
|
||
|
|
#define CACHE_SIZE 16*1024
|
||
|
|
#define CACHE_LINE_SIZE 32
|
||
|
|
#define KSEG0 0x80000000
|
||
|
|
|
||
|
|
|
||
|
|
#define K0_TO_K1() \
|
||
|
|
do { \
|
||
|
|
unsigned long __k0_addr; \
|
||
|
|
\
|
||
|
|
__asm__ __volatile__( \
|
||
|
|
"la %0, 1f\n\t" \
|
||
|
|
"or %0, %0, %1\n\t" \
|
||
|
|
"jr %0\n\t" \
|
||
|
|
"nop\n\t" \
|
||
|
|
"1: nop\n" \
|
||
|
|
: "=&r"(__k0_addr) \
|
||
|
|
: "r" (0x20000000) ); \
|
||
|
|
} while(0)
|
||
|
|
|
||
|
|
#define K1_TO_K0() \
|
||
|
|
do { \
|
||
|
|
unsigned long __k0_addr; \
|
||
|
|
__asm__ __volatile__( \
|
||
|
|
"nop;nop;nop;nop;nop;nop;nop\n\t" \
|
||
|
|
"la %0, 1f\n\t" \
|
||
|
|
"jr %0\n\t" \
|
||
|
|
"nop\n\t" \
|
||
|
|
"1: nop\n" \
|
||
|
|
: "=&r" (__k0_addr)); \
|
||
|
|
} while (0)
|
||
|
|
|
||
|
|
#define INVALIDATE_BTB() \
|
||
|
|
do { \
|
||
|
|
unsigned long tmp; \
|
||
|
|
__asm__ __volatile__( \
|
||
|
|
".set mips32\n\t" \
|
||
|
|
"mfc0 %0, $16, 7\n\t" \
|
||
|
|
"nop\n\t" \
|
||
|
|
"ori %0, 2\n\t" \
|
||
|
|
"mtc0 %0, $16, 7\n\t" \
|
||
|
|
"nop\n\t" \
|
||
|
|
".set mips2\n\t" \
|
||
|
|
: "=&r" (tmp)); \
|
||
|
|
} while (0)
|
||
|
|
|
||
|
|
#define SYNC_WB() __asm__ __volatile__ ("sync")
|
||
|
|
|
||
|
|
#define cache_op(op,addr) \
|
||
|
|
__asm__ __volatile__( \
|
||
|
|
" .set noreorder \n" \
|
||
|
|
" .set mips32\n\t \n" \
|
||
|
|
" cache %0, %1 \n" \
|
||
|
|
" .set mips0 \n" \
|
||
|
|
" .set reorder" \
|
||
|
|
: \
|
||
|
|
: "i" (op), "m" (*(unsigned char *)(addr)))
|
||
|
|
|
||
|
|
void __icache_invalidate_all(void)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
|
||
|
|
K0_TO_K1();
|
||
|
|
|
||
|
|
asm volatile (".set noreorder\n"
|
||
|
|
".set mips32\n\t"
|
||
|
|
"mtc0\t$0,$28\n\t"
|
||
|
|
"mtc0\t$0,$29\n"
|
||
|
|
".set mips0\n"
|
||
|
|
".set reorder\n");
|
||
|
|
for (i=KSEG0;i<KSEG0+CACHE_SIZE;i+=CACHE_LINE_SIZE)
|
||
|
|
cache_op(Index_Store_Tag_I, i);
|
||
|
|
|
||
|
|
K1_TO_K0();
|
||
|
|
|
||
|
|
INVALIDATE_BTB();
|
||
|
|
}
|
||
|
|
|
||
|
|
void __dcache_writeback_all(void)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
for (i=KSEG0;i<KSEG0+CACHE_SIZE;i+=CACHE_LINE_SIZE)
|
||
|
|
cache_op(Index_Writeback_Inv_D, i);
|
||
|
|
SYNC_WB();
|
||
|
|
}
|
||
|
|
|
||
|
|
void rt_hw_cache_init(void)
|
||
|
|
{
|
||
|
|
__dcache_writeback_all();
|
||
|
|
__icache_invalidate_all();
|
||
|
|
}
|