Firebee/FireBee_SVN
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

added function to clear cache

Browse Source
This commit is contained in:
Markus Fröschle
2012-10-16 17:51:37 +00:00
parent 2f3dd0375c
commit 8a9d0def72
1 changed files with 34 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

36
sources/cache.c
View File

@@ -6,7 +6,7 @@
void flushDataCacheRegion(void *adr, uint32_t length) void flushDataCacheRegion(void *adr, uint32_t length)
{ {
asm volatile __asm__
( (
" move.l %0,d0 | start address\n\t" " move.l %0,d0 | start address\n\t"
" move.l d0,a1\n\t" " move.l d0,a1\n\t"
@@ -34,7 +34,7 @@ void flushDataCacheRegion(void *adr, uint32_t length)
void flushInstructionCacheRegion(void *adr, uint32_t length) void flushInstructionCacheRegion(void *adr, uint32_t length)
{ {
asm volatile __asm__
( (
" move.l %0,d0 | start address\n\t" " move.l %0,d0 | start address\n\t"
" move.l d0,a1\n\t" " move.l d0,a1\n\t"
@@ -59,3 +59,35 @@ void flushInstructionCacheRegion(void *adr, uint32_t length)
/* clobber */: "d0", "d1", "a0", "a1" /* clobber */: "d0", "d1", "a0", "a1"
); );
} }
void clear_caches(void)
{
__asm__ (
"cpusha:\n\t"
" move sr,d2\n\t"
" move.l d2,-(sp)\n\t"
" move #0x2700,sr | no interrupts\n\t"
" clr.l d0\n\t"
" clr.l d1\n\t"
" move.l d0,a0\n\t"
"cfa_setloop:\n\t"
" cpushl bc,(a0) | flush\n\t"
" lea 0x10(a0),a0 | index+1\n\t"
" addq.l #1,d1 | index+1\n\t"
" cmpi.w #512,d1 | alle sets?\n\t"
" bne cfa_setloop | nein->\n\t"
" clr.l d1\n\t"
" addq.l #1,d0\n\t"
" move.l d0,a0\n\t"
" cmpi.w #4,d0 | all ways?\n\t"
" bne cfa_setloop | nein->\n\t"
" nop\n\t"
" move.l _rt_cacr,d0 | holen\n\t"
" movec d0,cacr | setzen\n\t"
" move.l (sp)+,d2\n\t"
" move.w d2,sr | alte interrupt maske\n\t"
/* input */ :
/* output */ :
/* clobber */ : "d0", "d1", "d2", "a0"
);
}