brain-hackers_pepepper-mirror
/
lab
mirror of https://github.com/brain-hackers/lab
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

Update injector impl

This commit is contained in:
Takumi Sueda 2021-03-11 13:35:07 +09:00
parent 40ab815357
commit 7c2200e371
1 changed files with 39 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

46
x1/injector/disable_mmu.S
View File

@ -15,12 +15,44 @@ _start:
mcr p15, 0, r8, c14, c3, 1
mov r9, #0
mrc p15, 0, r10, c1, c0, 0
@bic r10, r10, #5 @ disable MMU and dcache
bic r10, r10, #1 @ disable MMU
@bic r10, r10, #4096 @ disable icache
mcr p15, 0, r10, c1, c0, 0 // write ctrl regs
#mcr p15, 0, r9, c7, c7, 0 // invalidate cache
#mcr p15, 0, r9, c8, c7, 0 // invalidate TLB
mrc p15, 0, r6, c1, c0, 0
bic r6, r6, #4 @ disable dcache
bic r6, r6, #4096 @ disable icache
mcr p15, 0, r6, c1, c0, 0 // write ctrl regs
mcr p15, 0, r9, c7, c5, 0 // invalidate icache
// from: https://www.aps-web.jp/academy/ca/229/#i-2
mov r10,#0 // データキャッシュを選択
mcr p15,2,r10,c0,c0,0 // キャッシュサイズ選択レジスタ（CSSELR）で
// データキャッシュを選択
isb // 命令同期バリア命令で再フェッチ
mrc p15,1,r1,c0,c0,0 // CCSIDRを読み込み
and r2,r1,#7 // キャッシュラインサイズを取得（b001=8ワード/ライン）
add r2,r2,#4 // DCISWレジスタのセット番号のシフト数を求める
ldr r4,=0x3FF // 最大ウェイ数マスク設定値を設定
ands r4,r4,r1,LSR #3 // r4レジスタにウェイ数を設定
clz r5,r4 // DCISWレジスタのウェイ番号のシフト数を求める
ldr r7,=0x7FFF // セット数マスク設定値を設定
ands r7,r7,r1,LSR #13 // r7レジスタにセット数を設定
// 0x7F=12Kbyte/0xFF=32Kbyte/0x1FF=64Kbyte
loop2:
mov r9,r4 // r9レジスタにウェイ数を設定
loop3:
orr r11,r10,r9,LSL r5 // ウェイ番号とキャッシュ番号を設定
orr r11,r11,r7,LSL r2 // セット番号を設定
mcr p15,0,r11,c7,c6,2 // DCISWレジスタでセット/ウェイによる
// データキャッシュラインの無効化
subs r9,r9,#1 // ウェイ番号を-1
bge loop3 // ウェイ毎の初期化を実施
subs r7,r7,#1 // セット番号を-1
bge loop2 // セット毎の初期化を実施
mcr p15, 0, r9, c8, c7, 0 // invalidate TLB
mcr p15, 0, r9, c7, c5, 6 // invalidate branch predictor array
bic r6, r6, #1 @ disable MMU
mcr p15, 0, r6, c1, c0, 0 // write ctrl regs
mov pc, r0