fork/training-mode-ce
git clone https://git.julia.blue/fork/training-mode-ce
2c08d3a
master
1# To be inserted @ 803d7074 2.include "../../Globals.s" 3.include "../Header.s" 4 5########################################### 6# Intialize pointers 7.set REG_Count , 12 8.set REG_Code , 11 9.set REG_RelocTable , 10 10mr REG_Count , r3 11mr REG_Code , r4 12mr REG_RelocTable , r5 13 14Reloc_Loop : 15.set REG_CodePointer , 9 16.set REG_FuncPointer , 8 17.set REG_Flag , 7 18lwz r3 , 0x0 ( REG_RelocTable ) 19rlwinm REG_Flag , r3 , 8 , 0x000000FF # get flag 20rlwinm r3 , r3 , 0 , 0x00FFFFFF 21add REG_CodePointer , r3 , REG_Code # get code offset 22 23# First check if a bl to an dol address 24lwz r3 , 0x4 ( REG_RelocTable ) 25rlwinm r0 , r3 , 8 , 0x000000F0 26cmpwi r0 , 0x80 27beq Reloc_DOLAddr 28 29Reloc_CodeAddr : 30add REG_FuncPointer , r3 , REG_Code # get func offset 31b Reloc_CheckType 32 33Reloc_DOLAddr : 34lwz REG_FuncPointer , 0x4 ( REG_RelocTable ) # get func offset 35 36Reloc_CheckType : 37# Check flag type 38cmpwi REG_Flag , 1 39beq Reloc_StaticAddress 40cmpwi REG_Flag , 4 41beq Reloc_LoadAddress 42cmpwi REG_Flag , 6 43beq Reloc_LoadAddress 44cmpwi REG_Flag , 10 45beq Reloc_Branch 46cmpwi REG_Flag , 26 47beq Reloc_Relative32Bit 48b Reloc_IncLoop 49 50Reloc_StaticAddress : 51# lwz r3, 0x0(REG_FuncPointer) 52stw REG_FuncPointer , 0x0 ( REG_CodePointer ) 53b Reloc_IncLoop 54 55############################################ 56Reloc_LoadAddress : 57# Now check if the low bits are signed 58rlwinm. r3 , REG_FuncPointer , 17 , 0x1 59beq Reloc_CheckFlag 60# Adjust this address to load a negative offset 61.set REG_NewHigh , 6 62.set REG_NewLow , 5 63# High bits 64rlwinm r3 , REG_FuncPointer , 16 , 0x0000FFFF 65addi r3 , r3 , 1 66slwi REG_NewHigh , r3 , 16 67# Low bits 68sub r3 , REG_FuncPointer , REG_NewHigh 69rlwinm REG_NewLow , r3 , 0 , 0x0000FFFF 70or REG_FuncPointer , REG_NewHigh , REG_NewLow 71 72Reloc_CheckFlag : 73# Check flag type 74cmpwi REG_Flag , 4 75beq Reloc_Low16 76cmpwi REG_Flag , 6 77beq Reloc_High16 78 79Reloc_High16 : 80rlwinm r3 , REG_FuncPointer , 16 , 0x0000FFFF 81b Reloc_Store 82 83Reloc_Low16 : 84rlwinm r3 , REG_FuncPointer , 0 , 0x0000FFFF 85b Reloc_Store 86 87Reloc_Store : 88sth r3 , 0x0 ( REG_CodePointer ) 89b Reloc_IncLoop 90 91############################################ 92Reloc_Branch : 93# Store branch to this code 94sub r3 , REG_FuncPointer , REG_CodePointer # Difference relative to branch addr 95rlwinm r3 , r3 , 0 , 6 , 29 # extract bits for offset 96lwz r4 , 0x0 ( REG_CodePointer ) # place branch instruction 97or r3 , r3 , r4 98stw r3 , 0x0 ( REG_CodePointer ) # place branch instruction 99b Reloc_IncLoop 100 101############################################ 102Reloc_Relative32Bit : 103# Store offset? 104# Store branch to this code 105sub r3 , REG_FuncPointer , REG_CodePointer # Difference relative to branch addr 106stw r3 , 0x0 ( REG_CodePointer ) # place branch instruction 107b Reloc_IncLoop 108 109############################################ 110Reloc_IncLoop : 111addi REG_RelocTable , REG_RelocTable , 8 112subi REG_Count , REG_Count , 1 113cmpwi REG_Count , 0 114bgt Reloc_Loop 115blr 116##############################################