| 28,8 → 28,26 |
|---|
| |
| #include "asm.h" |
| #include "regname.h" |
| #include "debug.inc" |
| |
| .macro SMC_COHERENCY addr |
| dcbst 0, \addr |
| sync |
| icbi 0, \addr |
| sync |
| isync |
| .endm |
| |
| .macro FLUSH_DCACHE addr |
| dcbst 0, \addr |
| sync |
| isync |
| .endm |
| |
| .macro TLB_FLUSH reg |
| tlbie \reg |
| addi \reg, \reg, 0x1000 |
| .endm |
| |
| .text |
| |
| .global halt |
| 140,9 → 158,6 |
|---|
| |
| real_mode: |
| |
| DEBUG_INIT |
| DEBUG_real_mode |
| |
| # copy kernel to proper location |
| # |
| # r5 = trans (pa) |
| 163,14 → 178,13 |
|---|
| mtctr r31 |
| lwz r29, 0(r5) |
| |
| DEBUG_INIT |
| DEBUG_copy_loop |
| |
| copy_loop: |
| |
| lwz r28, 0(r29) |
| stw r28, 0(r30) |
| |
| SMC_COHERENCY r30 |
| |
| addi r29, r29, 4 |
| addi r30, r30, 4 |
| subi r6, r6, 4 |
| 180,15 → 194,11 |
|---|
| |
| bdnz copy_loop |
| |
| DEBUG_end_copy_loop |
| |
| addi r5, r5, 4 |
| b page_copy |
| |
| copy_end: |
| |
| DEBUG_segments |
| |
| # initially fill segment registers |
| |
| li r31, 0 |
| 196,7 → 206,7 |
|---|
| li r29, 8 |
| mtctr r29 |
| li r30, 0 # ASID 0 (VSIDs 0 .. 7) |
| |
| |
| seg_fill_uspace: |
| |
| mtsrin r30, r31 |
| 220,8 → 230,6 |
|---|
| |
| # invalidate block address translation registers |
| |
| DEBUG_bat |
| |
| li r30, 0 |
| |
| mtspr ibat0u, r30 |
| 251,8 → 259,6 |
|---|
| # create empty Page Hash Table |
| # on top of memory, size 64 KB |
| |
| DEBUG_pht |
| |
| lwz r31, 0(r3) # r31 = memory size |
| |
| lis r30, 65536@h |
| 274,6 → 280,7 |
|---|
| # write zeroes |
| |
| stw r29, 0(r31) |
| FLUSH_DCACHE r31 |
| |
| addi r31, r31, 4 |
| subi r30, r30, 4 |
| 282,8 → 289,6 |
|---|
| beq clear_end |
| |
| bdnz pht_clear |
| |
| DEBUG_end_pht_clear |
| |
| clear_end: |
| |
| 291,8 → 296,6 |
|---|
| |
| # create BAT identity mapping |
| |
| DEBUG_mapping |
| |
| lwz r31, 0(r3) # r31 = memory size |
| |
| lis r29, 0x0002 |
| 315,8 → 318,6 |
|---|
| |
| bdnz bat_mask |
| |
| DEBUG_bat_mask |
| |
| andi. r31, r31, 0x07ff # mask = mask & 0x07ff (BAT can map up to 256 MB) |
| |
| li r29, 2 |
| 336,16 → 337,90 |
|---|
| mtspr dbat0l, r30 |
| |
| no_bat: |
| |
| |
| #endif |
| |
| DEBUG_tlb |
| # flush TLB |
| |
| tlbia |
| li r31, 0 |
| sync |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| TLB_FLUSH r31 |
| |
| eieio |
| tlbsync |
| sync |
| |
| DEBUG_prepare |
| |
| # start the kernel |
| # |
| # pc = KERNEL_START_ADDR |
| 373,8 → 448,6 |
|---|
| |
| sync |
| isync |
| |
| DEBUG_rfi |
| rfi |
| |
| .align PAGE_WIDTH |