[picodrive.git] / Pico / Memory_amips.s

# vim:filetype=mips

# memory handlers with banking support for SSF II - The New Challengers
# mostly based on Gens code

# (c) Copyright 2007, Grazvydas "notaz" Ignotas
# All Rights Reserved


.set noreorder
.set noat

.text
.align 4

# default jump tables

m_read8_def_table:
    .long   m_read8_rom0    # 0x000000 - 0x07FFFF
    .long   m_read8_rom1    # 0x080000 - 0x0FFFFF
    .long   m_read8_rom2    # 0x100000 - 0x17FFFF
    .long   m_read8_rom3    # 0x180000 - 0x1FFFFF
    .long   m_read8_rom4    # 0x200000 - 0x27FFFF
    .long   m_read8_rom5    # 0x280000 - 0x2FFFFF
    .long   m_read8_rom6    # 0x300000 - 0x37FFFF
    .long   m_read8_rom7    # 0x380000 - 0x3FFFFF
    .long   m_read8_rom8    # 0x400000 - 0x47FFFF - for all those large ROM hacks
    .long   m_read8_rom9    # 0x480000 - 0x4FFFFF
    .long   m_read8_romA    # 0x500000 - 0x57FFFF
    .long   m_read8_romB    # 0x580000 - 0x5FFFFF
    .long   m_read8_romC    # 0x600000 - 0x67FFFF
    .long   m_read8_romD    # 0x680000 - 0x6FFFFF
    .long   m_read8_romE    # 0x700000 - 0x77FFFF
    .long   m_read8_romF    # 0x780000 - 0x7FFFFF
    .long   m_read8_rom10   # 0x800000 - 0x87FFFF
    .long   m_read8_rom11   # 0x880000 - 0x8FFFFF
    .long   m_read8_rom12   # 0x900000 - 0x97FFFF
    .long   m_read8_rom13   # 0x980000 - 0x9FFFFF
    .long   m_read8_misc    # 0xA00000 - 0xA7FFFF
    .long   m_read_null     # 0xA80000 - 0xAFFFFF
    .long   m_read_null     # 0xB00000 - 0xB7FFFF
    .long   m_read_null     # 0xB80000 - 0xBFFFFF
    .long   m_read8_vdp     # 0xC00000 - 0xC7FFFF
    .long   m_read8_vdp     # 0xC80000 - 0xCFFFFF
    .long   m_read8_vdp     # 0xD00000 - 0xD7FFFF
    .long   m_read8_vdp     # 0xD80000 - 0xDFFFFF
    .long   m_read8_ram     # 0xE00000 - 0xE7FFFF
    .long   m_read8_ram     # 0xE80000 - 0xEFFFFF
    .long   m_read8_ram     # 0xF00000 - 0xF7FFFF
    .long   m_read8_ram     # 0xF80000 - 0xFFFFFF

m_read16_def_table:
    .long   m_read16_rom0    # 0x000000 - 0x07FFFF
    .long   m_read16_rom1    # 0x080000 - 0x0FFFFF
    .long   m_read16_rom2    # 0x100000 - 0x17FFFF
    .long   m_read16_rom3    # 0x180000 - 0x1FFFFF
    .long   m_read16_rom4    # 0x200000 - 0x27FFFF
    .long   m_read16_rom5    # 0x280000 - 0x2FFFFF
    .long   m_read16_rom6    # 0x300000 - 0x37FFFF
    .long   m_read16_rom7    # 0x380000 - 0x3FFFFF
    .long   m_read16_rom8    # 0x400000 - 0x47FFFF
    .long   m_read16_rom9    # 0x480000 - 0x4FFFFF
    .long   m_read16_romA    # 0x500000 - 0x57FFFF
    .long   m_read16_romB    # 0x580000 - 0x5FFFFF
    .long   m_read16_romC    # 0x600000 - 0x67FFFF
    .long   m_read16_romD    # 0x680000 - 0x6FFFFF
    .long   m_read16_romE    # 0x700000 - 0x77FFFF
    .long   m_read16_romF    # 0x780000 - 0x7FFFFF
    .long   m_read16_rom10   # 0x800000 - 0x87FFFF
    .long   m_read16_rom11   # 0x880000 - 0x8FFFFF
    .long   m_read16_rom12   # 0x900000 - 0x97FFFF
    .long   m_read16_rom13   # 0x980000 - 0x9FFFFF
    .long   m_read16_misc    # 0xA00000 - 0xA7FFFF
    .long   m_read_null      # 0xA80000 - 0xAFFFFF
    .long   m_read_null      # 0xB00000 - 0xB7FFFF
    .long   m_read_null      # 0xB80000 - 0xBFFFFF
    .long   m_read16_vdp     # 0xC00000 - 0xC7FFFF
    .long   m_read16_vdp     # 0xC80000 - 0xCFFFFF
    .long   m_read16_vdp     # 0xD00000 - 0xD7FFFF
    .long   m_read16_vdp     # 0xD80000 - 0xDFFFFF
    .long   m_read16_ram     # 0xE00000 - 0xE7FFFF
    .long   m_read16_ram     # 0xE80000 - 0xEFFFFF
    .long   m_read16_ram     # 0xF00000 - 0xF7FFFF
    .long   m_read16_ram     # 0xF80000 - 0xFFFFFF

m_read32_def_table:
    .long   m_read32_rom0    # 0x000000 - 0x07FFFF
    .long   m_read32_rom1    # 0x080000 - 0x0FFFFF
    .long   m_read32_rom2    # 0x100000 - 0x17FFFF
    .long   m_read32_rom3    # 0x180000 - 0x1FFFFF
    .long   m_read32_rom4    # 0x200000 - 0x27FFFF
    .long   m_read32_rom5    # 0x280000 - 0x2FFFFF
    .long   m_read32_rom6    # 0x300000 - 0x37FFFF
    .long   m_read32_rom7    # 0x380000 - 0x3FFFFF
    .long   m_read32_rom8    # 0x400000 - 0x47FFFF
    .long   m_read32_rom9    # 0x480000 - 0x4FFFFF
    .long   m_read32_romA    # 0x500000 - 0x57FFFF
    .long   m_read32_romB    # 0x580000 - 0x5FFFFF
    .long   m_read32_romC    # 0x600000 - 0x67FFFF
    .long   m_read32_romD    # 0x680000 - 0x6FFFFF
    .long   m_read32_romE    # 0x700000 - 0x77FFFF
    .long   m_read32_romF    # 0x780000 - 0x7FFFFF
    .long   m_read32_rom10   # 0x800000 - 0x87FFFF
    .long   m_read32_rom11   # 0x880000 - 0x8FFFFF
    .long   m_read32_rom12   # 0x900000 - 0x97FFFF
    .long   m_read32_rom13   # 0x980000 - 0x9FFFFF
    .long   m_read32_misc    # 0xA00000 - 0xA7FFFF
    .long   m_read_null      # 0xA80000 - 0xAFFFFF
    .long   m_read_null      # 0xB00000 - 0xB7FFFF
    .long   m_read_null      # 0xB80000 - 0xBFFFFF
    .long   m_read32_vdp     # 0xC00000 - 0xC7FFFF
    .long   m_read32_vdp     # 0xC80000 - 0xCFFFFF
    .long   m_read32_vdp     # 0xD00000 - 0xD7FFFF
    .long   m_read32_vdp     # 0xD80000 - 0xDFFFFF
    .long   m_read32_ram     # 0xE00000 - 0xE7FFFF
    .long   m_read32_ram     # 0xE80000 - 0xEFFFFF
    .long   m_read32_ram     # 0xF00000 - 0xF7FFFF
    .long   m_read32_ram     # 0xF80000 - 0xFFFFFF


# #############################################################################

.bss
.align 4

# used tables
m_read8_table:
    .skip 32*4

m_read16_table:
    .skip 32*4

m_read32_table:
    .skip 32*4


# #############################################################################

.text
.align 4

.global PicoMemReset
.global PicoRead8
.global PicoRead16
.global PicoRead32
.global PicoWriteRomHW_SSF2

.global m_read8_def_table
.global m_read8_table

.macro PicoMemResetCopyDef dst_table src_table
    lui     $t0, %hi(\dst_table)
    addiu   $t0, %lo(\dst_table)
    lui     $t1, %hi(\src_table)
    addiu   $t1, %lo(\src_table)
    li      $t2, 32
1:
    lw      $t3, 0($t1)
    sw      $t3, 0($t0)
    addiu   $t2, -1
    addiu   $t1, 4
    bnez    $t2, 1b
    addiu   $t0, 4
.endm

# $t4 = 4
.macro PicoMemResetRomArea dst_table ar_label
    lui     $t0, %hi(\dst_table)
    addiu   $t0, %lo(\dst_table)
    lui     $t1, %hi(\ar_label)
    addiu   $t1, %lo(\ar_label)
    li      $t2, 20
1:
    beq     $t2, $v1, 2f
    addiu   $t2, -1
    sll     $t3, $t2, 2
    beq     $t2, $t4, 1b           # do not touch the SRAM area
    addu    $t3, $t0
    j       1b
    sw      $t1, 0($t3)
2:
.endm


PicoMemReset:
    lui     $v1, %hi(Pico+0x22204)
    lw      $v1, %lo(Pico+0x22204)($v1)  # romsize
    lui     $t0, 8
    addu    $v1, $t0
    addiu   $v1, -1
    srl     $v1, 19

    PicoMemResetCopyDef m_read8_table  m_read8_def_table
    PicoMemResetCopyDef m_read16_table m_read16_def_table
    PicoMemResetCopyDef m_read32_table m_read32_def_table

    # update memhandlers according to ROM size
    li      $t4, 4
    PicoMemResetRomArea m_read8_table  m_read8_above_rom
    PicoMemResetRomArea m_read16_table m_read16_above_rom
    PicoMemResetRomArea m_read32_table m_read32_above_rom

    jr      $ra
    nop

# #############################################################################

.macro PicoReadJump table
    lui     $t0, %hi(\table)
    srl     $t1, $a0, 19
    ins     $t0, $t1, 2, 5
    lw      $t0, %lo(\table)($t0)
    ins     $a0, $0,  24, 8
    jr      $t0
    nop
.endm

PicoRead8: # u32 a
    PicoReadJump m_read8_table

PicoRead16: # u32 a
    PicoReadJump m_read16_table

PicoRead32: # u32 a
    PicoReadJump m_read32_table

# #############################################################################

m_read_null:
    jr      $ra
    li      $v0, 0

m_read_neg1:
    jr      $ra
    addiu   $v0, $0, 0xffff

# loads &Pico.rom to $t3
.macro m_read_rom_try_sram is200000 size
    lui     $t2, %hi(SRam)
    addiu   $t2, %lo(SRam)
    lui     $t3, %hi(Pico+0x22200)
    lw      $t1, 8($t2)     # SRam.end
.if \is200000
    ins     $a0, $0,  19, 13
    lui     $t4, 0x20
    or      $a0, $t4
.endif
    subu    $t4, $a0, $t1
    bgtz    $t4, 1f
    addiu   $t3, %lo(Pico+0x22200)
    lw      $t1, 4($t2)     # SRam.start
    subu    $t4, $t1, $a0
    bgtz    $t4, 1f
    nop
    lb      $t1, 0x11($t3)  # Pico.m.sram_reg
    andi    $t4, $t1, 5
    beqz    $t4, 1f
    nop
.if \size == 8
    j       SRAMRead
    nop
.elseif \size == 16
    sw      $ra, -4($sp)
    jal     SRAMRead16
    addiu   $sp, -4
    lw      $ra, 0($sp)
    jr      $ra
    addiu   $sp, 4
.else
    addiu   $sp, -8
    sw      $ra, 0($sp)
    sw      $a0, 4($sp)
    jal     SRAMRead16
    nop
    lw      $a0, 4($sp)
    sw      $v0, 4($sp)
    jal     SRAMRead16
    addiu   $a0, 2
    lw      $v1, 4($sp)
    lw      $ra, 0($sp)
    addiu   $sp, 8
    jr      $ra
    ins     $v0, $v1, 16, 16
.endif
# m_read_nosram:
1:
.endm

.macro m_read8_rom sect
    lui     $t0, %hi(Pico+0x22200)
    lw      $t0, %lo(Pico+0x22200)($t0)  # rom
    xori    $a0, 1
    ins     $a0, $0,  19, 13
.if \sect
    lui     $t1, 8*\sect
    addu    $a0, $t1
.endif
    addu    $t0, $a0
    jr      $ra
    lb      $v0, 0($t0)
.endm


m_read8_rom0: # 0x000000 - 0x07ffff
    m_read8_rom 0

m_read8_rom1: # 0x080000 - 0x0fffff
    m_read8_rom 1

m_read8_rom2: # 0x100000 - 0x17ffff
    m_read8_rom 2

m_read8_rom3: # 0x180000 - 0x1fffff
    m_read8_rom 3

m_read8_rom4: # 0x200000 - 0x27ffff, SRAM area
    m_read_rom_try_sram 1 8
    lw      $t1, 4($t3)     # romsize
    subu    $t4, $t1, $a0
    blez    $t4, m_read_null
    lw      $t1, 0($t3)     # rom
    xori    $a0, 1
    addu    $t1, $a0
    jr      $ra
    lb      $v0, 0($t1)

m_read8_rom5: # 0x280000 - 0x2fffff
    m_read8_rom 5

m_read8_rom6: # 0x300000 - 0x37ffff
    m_read8_rom 6

m_read8_rom7: # 0x380000 - 0x3fffff
    m_read8_rom 7

m_read8_rom8: # 0x400000 - 0x47ffff
    m_read8_rom 8

m_read8_rom9: # 0x480000 - 0x4fffff
    m_read8_rom 9

m_read8_romA: # 0x500000 - 0x57ffff
    m_read8_rom 0xA

m_read8_romB: # 0x580000 - 0x5fffff
    m_read8_rom 0xB

m_read8_romC: # 0x600000 - 0x67ffff
    m_read8_rom 0xC

m_read8_romD: # 0x680000 - 0x6fffff
    m_read8_rom 0xD

m_read8_romE: # 0x700000 - 0x77ffff
    m_read8_rom 0xE

m_read8_romF: # 0x780000 - 0x7fffff
    m_read8_rom 0xF

m_read8_rom10: # 0x800000 - 0x87ffff
    m_read8_rom 0x10

m_read8_rom11: # 0x880000 - 0x8fffff
    m_read8_rom 0x11

m_read8_rom12: # 0x900000 - 0x97ffff
    m_read8_rom 0x12

m_read8_rom13: # 0x980000 - 0x9fffff
    m_read8_rom 0x13


m_read8_misc:
    srl     $t0, $a0, 5
    sll     $t0, $t0, 5
    lui     $t1, 0xa1
    bne     $t0, $t1, m_read8_misc2
    andi    $t0, $a0, 0x1e
m_read8_misc_io:
    beqz    $t0, m_read8_misc_hwreg
    sub     $t1, $t0, 4
    bgtz    $t1, m_read8_misc_ioports
    nop
    slti    $a0, $t0, 4
    xori    $a0, 1
    j       PadRead
    nop

m_read8_misc_hwreg:
    lui     $v0, %hi(Pico+0x2220f)
    jr      $ra
    lb      $v0, %lo(Pico+0x2220f)($v0)

m_read8_misc_ioports:
    lui     $v0, %hi(Pico+0x22000)
    ins     $v0, $t0, 0, 5
    jr      $ra
    lb      $v0, %lo(Pico+0x22000)($v0)

m_read8_misc2:
    lui     $t0, 0xa1
    ori     $t0, 0x1100
    bne     $a0, $t0, m_read8_misc3
    srl     $t0, $a0, 16
    j       z80ReadBusReq

m_read8_misc3:
    addiu   $t0, 0xff60       # expecting 0xa0 to get 0
    bnez    $t0, m_read8_misc4

    # z80 area
    andi    $t0, $a0, 0x4000
    bnez    $t0, m_read8_z80_misc
    andi    $t0, $a0, 0x6000
    j       z80Read8          # z80 RAM

m_read8_z80_misc:
    addiu   $t0, 0xc000       # expecting 0x4000 to get 0
    bnez    $t0, m_read_neg1  # invalid

    lui     $t0, %hi(PicoOpt)
    lw      $t0, %lo(PicoOpt)($t0)
    andi    $t0, 1
    bnez    $t0, ym2612_read_local_68k
    nop

m_read8_fake_ym2612:
    lb      $v0, %lo(Pico+0x22208)($t0) # Pico.m.rotate
    addiu   $t1, $v0, 1
    jr      $ra
    sb      $t1, %lo(Pico+0x22208)($t0)

# delay slot friendly
.macro m_read8_call16 funcname is_func_ptr=0
.if \is_func_ptr
    lui     $t1, %hi(\funcname)
    lw      $t1, %lo(\funcname)($t1)
.endif
    andi    $t0, $a0, 1
    beqz    $t0, 1f
    li      $a1, 8      # not always needed, but shouln't cause problems
.if \is_func_ptr
    jr      $t1
.else
    j       \funcname   # odd address
.endif
    nop
1:
    addiu   $sp, -4
    sw      $ra, 0($sp)
.if \is_func_ptr
    jalr    $t1
.else
    jal     \funcname
.endif
    xori    $a0, 1
    lw      $ra, 0($sp)
    addiu   $sp, 4
    jr      $ra
    srl     $v0, 8
.endm

m_read8_misc4:
    # if everything else fails, use generic handler
    m_read8_call16 OtherRead16

m_read8_vdp:
    ext     $t0, $a0, 16, 3
    andi    $t1, $a0, 0xe0
    or      $t0, $t1
    bnez    $t0, m_read_null # invalid address
    m_read8_call16 PicoVideoRead

m_read8_ram:
    lui     $t0, %hi(Pico)
    ins     $t0, $a0, 0, 16
    xori    $t0, 1
    jr      $ra
    lb      $v0, %lo(Pico)($t0)

m_read8_above_rom:
    # might still be SRam (Micro Machines, HardBall '95)
    m_read_rom_try_sram 0 8
    m_read8_call16 PicoRead16Hook 1

# #############################################################################

.macro m_read16_rom sect
    lui     $t0, %hi(Pico+0x22200)
    lw      $t0, %lo(Pico+0x22200)($t0)  # rom
    ins     $a0, $0,   0,  1
    ins     $a0, $0,  19, 13
.if \sect
    lui     $t1, 8*\sect
    addu    $a0, $t1
.endif
    addu    $t0, $a0
    jr      $ra
    lh      $v0, 0($t0)
.endm


m_read16_rom0: # 0x000000 - 0x07ffff
    m_read16_rom 0

m_read16_rom1: # 0x080000 - 0x0fffff
    m_read16_rom 1

m_read16_rom2: # 0x100000 - 0x17ffff
    m_read16_rom 2

m_read16_rom3: # 0x180000 - 0x1fffff
    m_read16_rom 3

m_read16_rom4: # 0x200000 - 0x27ffff, SRAM area
    m_read_rom_try_sram 1 16
    lw      $t1, 4($t3)     # romsize
    subu    $t4, $t1, $a0
    blez    $t4, m_read_null
    lw      $t1, 0($t3)     # rom
    ins     $a0, $0, 0, 1
    addu    $t1, $a0
    jr      $ra
    lh      $v0, 0($t1)

m_read16_rom5: # 0x280000 - 0x2fffff
    m_read16_rom 5

m_read16_rom6: # 0x300000 - 0x37ffff
    m_read16_rom 6

m_read16_rom7: # 0x380000 - 0x3fffff
    m_read16_rom 7

m_read16_rom8: # 0x400000 - 0x47ffff
    m_read16_rom 8

m_read16_rom9: # 0x480000 - 0x4fffff
    m_read16_rom 9

m_read16_romA: # 0x500000 - 0x57ffff
    m_read16_rom 0xA

m_read16_romB: # 0x580000 - 0x5fffff
    m_read16_rom 0xB

m_read16_romC: # 0x600000 - 0x67ffff
    m_read16_rom 0xC

m_read16_romD: # 0x680000 - 0x6fffff
    m_read16_rom 0xD

m_read16_romE: # 0x700000 - 0x77ffff
    m_read16_rom 0xE

m_read16_romF: # 0x780000 - 0x7fffff
    m_read16_rom 0xF

m_read16_rom10: # 0x800000 - 0x87ffff
    m_read16_rom 0x10

m_read16_rom11: # 0x880000 - 0x8fffff
    m_read16_rom 0x11

m_read16_rom12: # 0x900000 - 0x97ffff
    m_read16_rom 0x12

m_read16_rom13: # 0x980000 - 0x9fffff
    m_read16_rom 0x13

m_read16_misc:
    ins     $a0, $0, 0, 1
    j       OtherRead16
    li      $a1, 16

m_read16_vdp:
    ext     $t0, $a0, 16, 3
    andi    $t1, $a0, 0xe0
    or      $t0, $t1
    bnez    $t0, m_read_null # invalid address
    ins     $a0, $0, 0, 1
    j       PicoVideoRead
    nop

m_read16_ram:
    lui     $t0, %hi(Pico)
    ins     $a0, $0, 0, 1
    ins     $t0, $a0, 0, 16
    jr      $ra
    lh      $v0, %lo(Pico)($t0)

m_read16_above_rom:
    # might still be SRam
    m_read_rom_try_sram 0 16
    lui     $t1, %hi(PicoRead16Hook)
    lw      $t1, %lo(PicoRead16Hook)($t1)
    jr      $t1
    ins     $a0, $0, 0, 1

# #############################################################################

.macro m_read32_rom sect
    lui     $t0, %hi(Pico+0x22200)
    lw      $t0, %lo(Pico+0x22200)($t0)  # rom
    ins     $a0, $0,   0,  1
    ins     $a0, $0,  19, 13
.if \sect
    lui     $t1, 8*\sect
    addu    $a0, $t1
.endif
    addu    $t0, $a0
    lh      $v1, 0($t0)
    lh      $v0, 2($t0)
    jr      $ra
    ins     $v0, $v1, 16, 16
.endm


m_read32_rom0: # 0x000000 - 0x07ffff
    m_read32_rom 0

m_read32_rom1: # 0x080000 - 0x0fffff
    m_read32_rom 1

m_read32_rom2: # 0x100000 - 0x17ffff
    m_read32_rom 2

m_read32_rom3: # 0x180000 - 0x1fffff
    m_read32_rom 3

m_read32_rom4: # 0x200000 - 0x27ffff, SRAM area
    m_read_rom_try_sram 1 32
    lw      $t1, 4($t3)     # romsize
    subu    $t4, $t1, $a0
    blez    $t4, m_read_null
    lw      $t1, 0($t3)     # rom
    ins     $a0, $0, 0, 1
    addu    $t1, $a0
    lh      $v1, 0($t1)
    lh      $v0, 2($t1)
    jr      $ra
    ins     $v0, $v1, 16, 16

m_read32_rom5: # 0x280000 - 0x2fffff
    m_read32_rom 5

m_read32_rom6: # 0x300000 - 0x37ffff
    m_read32_rom 6

m_read32_rom7: # 0x380000 - 0x3fffff
    m_read32_rom 7

m_read32_rom8: # 0x400000 - 0x47ffff
    m_read32_rom 8

m_read32_rom9: # 0x480000 - 0x4fffff
    m_read32_rom 9

m_read32_romA: # 0x500000 - 0x57ffff
    m_read32_rom 0xA

m_read32_romB: # 0x580000 - 0x5fffff
    m_read32_rom 0xB

m_read32_romC: # 0x600000 - 0x67ffff
    m_read32_rom 0xC

m_read32_romD: # 0x680000 - 0x6fffff
    m_read32_rom 0xD

m_read32_romE: # 0x700000 - 0x77ffff
    m_read32_rom 0xE

m_read32_romF: # 0x780000 - 0x7fffff
    m_read32_rom 0xF

m_read32_rom10: # 0x800000 - 0x87ffff
    m_read32_rom 0x10

m_read32_rom11: # 0x880000 - 0x8fffff
    m_read32_rom 0x11

m_read32_rom12: # 0x900000 - 0x97ffff
    m_read32_rom 0x12

m_read32_rom13: # 0x980000 - 0x9fffff
    m_read32_rom 0x13

.macro m_read32_call16 func need_a1=0
    addiu   $sp, -8
    sw      $ra, 0($sp)
    sw      $s0, 4($sp)
.if \need_a1
    li      $a1, 16
.endif
    jal     \func
    move    $s0, $a0

    addu    $a0, $s0, 2
.if \need_a1
    li      $a1, 16
.endif
    jal     \func
    move    $s0, $v0

    ins     $v0, $s0, 16, 16
    lw      $ra, 0($sp)
    lw      $s0, 4($sp)
    jr      $ra
    addiu   $sp, 8
.endm

m_read32_misc:
    ins     $a0, $0, 0, 1
    m_read32_call16 OtherRead16, 1

m_read32_vdp:
    ext     $t0, $a0, 16, 3
    andi    $t1, $a0, 0xe0
    or      $t0, $t1
    bnez    $t0, m_read_null # invalid address
    ins     $a0, $0, 0, 1
    m_read32_call16 PicoVideoRead

m_read32_ram:
    lui     $t0, %hi(Pico)
    ins     $a0, $0, 0, 1
    ins     $t0, $a0, 0, 16
    lh      $v1, %lo(Pico)($t0)
    lh      $v0, %lo(Pico+2)($t0)
    jr      $ra
    ins     $v0, $v1, 16, 16

m_read32_above_rom:
    # might still be SRam
    m_read_rom_try_sram 0 32
    ins     $a0, $0, 0, 1
    lui     $t1, %hi(PicoRead16Hook)
    lw      $t1, %lo(PicoRead16Hook)($t1)
    addiu   $sp, -4*3
    sw      $ra, 0($sp)
    sw      $s0, 4($sp)
    sw      $t1, 8($sp)
    jalr    $t1
    move    $s0, $a0

    lw      $t1, 8($sp)
    addu    $a0, $s0, 2
    jalr    $t1
    move    $s0, $v0

    ins     $v0, $s0, 16, 16
    lw      $ra, 0($sp)
    lw      $s0, 4($sp)
    jr      $ra
    addiu   $sp, 4*3

# #############################################################################

.macro PicoWriteRomHW_SSF2_ls def_table table
    lui     $t3, %hi(\def_table)
    ins     $t3, $a1, 2, 5
    lw      $t0, %lo(\def_table)($t3)
    lui     $t2, %hi(\table)
    ins     $t2, $a0, 2, 3
    sw      $t0, %lo(\table)($t2)
.endm

PicoWriteRomHW_SSF2: # u32 a, u32 d
    ext     $a0, $a0, 1, 3
    bnez    $a0, pwr_banking

    # sram register
    lui     $t0, %hi(Pico+0x22211)
    lb      $t1, %lo(Pico+0x22211)($t0) # Pico.m.sram_reg
    ins     $t1, $a1, 0, 2
    jr      $ra
    sb      $t1, %lo(Pico+0x22211)($t0)

pwr_banking:
    andi    $a1, 0x1f

    PicoWriteRomHW_SSF2_ls m_read8_def_table  m_read8_table
    PicoWriteRomHW_SSF2_ls m_read16_def_table m_read16_table
    PicoWriteRomHW_SSF2_ls m_read32_def_table m_read32_table
 
    jr      $ra
    nop
Commit	Line	Data
3ec29f01	1	# vim:filetype=mips
	2
	3	# memory handlers with banking support for SSF II - The New Challengers
	4	# mostly based on Gens code
	5
	6	# (c) Copyright 2007, Grazvydas "notaz" Ignotas
	7	# All Rights Reserved
	8
	9
	10	.set noreorder
	11	.set noat
	12
	13	.text
	14	.align 4
	15
	16	# default jump tables
	17
	18	m_read8_def_table:
	19	.long m_read8_rom0 # 0x000000 - 0x07FFFF
	20	.long m_read8_rom1 # 0x080000 - 0x0FFFFF
	21	.long m_read8_rom2 # 0x100000 - 0x17FFFF
	22	.long m_read8_rom3 # 0x180000 - 0x1FFFFF
	23	.long m_read8_rom4 # 0x200000 - 0x27FFFF
	24	.long m_read8_rom5 # 0x280000 - 0x2FFFFF
	25	.long m_read8_rom6 # 0x300000 - 0x37FFFF
	26	.long m_read8_rom7 # 0x380000 - 0x3FFFFF
	27	.long m_read8_rom8 # 0x400000 - 0x47FFFF - for all those large ROM hacks
	28	.long m_read8_rom9 # 0x480000 - 0x4FFFFF
	29	.long m_read8_romA # 0x500000 - 0x57FFFF
	30	.long m_read8_romB # 0x580000 - 0x5FFFFF
	31	.long m_read8_romC # 0x600000 - 0x67FFFF
	32	.long m_read8_romD # 0x680000 - 0x6FFFFF
	33	.long m_read8_romE # 0x700000 - 0x77FFFF
	34	.long m_read8_romF # 0x780000 - 0x7FFFFF
	35	.long m_read8_rom10 # 0x800000 - 0x87FFFF
	36	.long m_read8_rom11 # 0x880000 - 0x8FFFFF
	37	.long m_read8_rom12 # 0x900000 - 0x97FFFF
	38	.long m_read8_rom13 # 0x980000 - 0x9FFFFF
	39	.long m_read8_misc # 0xA00000 - 0xA7FFFF
	40	.long m_read_null # 0xA80000 - 0xAFFFFF
	41	.long m_read_null # 0xB00000 - 0xB7FFFF
	42	.long m_read_null # 0xB80000 - 0xBFFFFF
	43	.long m_read8_vdp # 0xC00000 - 0xC7FFFF
	44	.long m_read8_vdp # 0xC80000 - 0xCFFFFF
	45	.long m_read8_vdp # 0xD00000 - 0xD7FFFF
	46	.long m_read8_vdp # 0xD80000 - 0xDFFFFF
	47	.long m_read8_ram # 0xE00000 - 0xE7FFFF
	48	.long m_read8_ram # 0xE80000 - 0xEFFFFF
	49	.long m_read8_ram # 0xF00000 - 0xF7FFFF
	50	.long m_read8_ram # 0xF80000 - 0xFFFFFF
	51
	52	m_read16_def_table:
	53	.long m_read16_rom0 # 0x000000 - 0x07FFFF
	54	.long m_read16_rom1 # 0x080000 - 0x0FFFFF
	55	.long m_read16_rom2 # 0x100000 - 0x17FFFF
	56	.long m_read16_rom3 # 0x180000 - 0x1FFFFF
	57	.long m_read16_rom4 # 0x200000 - 0x27FFFF
	58	.long m_read16_rom5 # 0x280000 - 0x2FFFFF
	59	.long m_read16_rom6 # 0x300000 - 0x37FFFF
	60	.long m_read16_rom7 # 0x380000 - 0x3FFFFF
	61	.long m_read16_rom8 # 0x400000 - 0x47FFFF
	62	.long m_read16_rom9 # 0x480000 - 0x4FFFFF
	63	.long m_read16_romA # 0x500000 - 0x57FFFF
	64	.long m_read16_romB # 0x580000 - 0x5FFFFF
65	.long m_read16_romC # 0x600000 - 0x67FFFF
66	.long m_read16_romD # 0x680000 - 0x6FFFFF
67	.long m_read16_romE # 0x700000 - 0x77FFFF
68	.long m_read16_romF # 0x780000 - 0x7FFFFF
69	.long m_read16_rom10 # 0x800000 - 0x87FFFF
70	.long m_read16_rom11 # 0x880000 - 0x8FFFFF
71	.long m_read16_rom12 # 0x900000 - 0x97FFFF
72	.long m_read16_rom13 # 0x980000 - 0x9FFFFF
73	.long m_read16_misc # 0xA00000 - 0xA7FFFF
74	.long m_read_null # 0xA80000 - 0xAFFFFF
75	.long m_read_null # 0xB00000 - 0xB7FFFF
76	.long m_read_null # 0xB80000 - 0xBFFFFF
77	.long m_read16_vdp # 0xC00000 - 0xC7FFFF
78	.long m_read16_vdp # 0xC80000 - 0xCFFFFF
79	.long m_read16_vdp # 0xD00000 - 0xD7FFFF
80	.long m_read16_vdp # 0xD80000 - 0xDFFFFF
81	.long m_read16_ram # 0xE00000 - 0xE7FFFF
82	.long m_read16_ram # 0xE80000 - 0xEFFFFF
83	.long m_read16_ram # 0xF00000 - 0xF7FFFF
84	.long m_read16_ram # 0xF80000 - 0xFFFFFF
85
86	m_read32_def_table:
87	.long m_read32_rom0 # 0x000000 - 0x07FFFF
88	.long m_read32_rom1 # 0x080000 - 0x0FFFFF
89	.long m_read32_rom2 # 0x100000 - 0x17FFFF
90	.long m_read32_rom3 # 0x180000 - 0x1FFFFF
91	.long m_read32_rom4 # 0x200000 - 0x27FFFF
92	.long m_read32_rom5 # 0x280000 - 0x2FFFFF
93	.long m_read32_rom6 # 0x300000 - 0x37FFFF
94	.long m_read32_rom7 # 0x380000 - 0x3FFFFF
95	.long m_read32_rom8 # 0x400000 - 0x47FFFF
96	.long m_read32_rom9 # 0x480000 - 0x4FFFFF
97	.long m_read32_romA # 0x500000 - 0x57FFFF
98	.long m_read32_romB # 0x580000 - 0x5FFFFF
99	.long m_read32_romC # 0x600000 - 0x67FFFF
100	.long m_read32_romD # 0x680000 - 0x6FFFFF
101	.long m_read32_romE # 0x700000 - 0x77FFFF
102	.long m_read32_romF # 0x780000 - 0x7FFFFF
103	.long m_read32_rom10 # 0x800000 - 0x87FFFF
104	.long m_read32_rom11 # 0x880000 - 0x8FFFFF
105	.long m_read32_rom12 # 0x900000 - 0x97FFFF
106	.long m_read32_rom13 # 0x980000 - 0x9FFFFF
107	.long m_read32_misc # 0xA00000 - 0xA7FFFF
108	.long m_read_null # 0xA80000 - 0xAFFFFF
109	.long m_read_null # 0xB00000 - 0xB7FFFF
110	.long m_read_null # 0xB80000 - 0xBFFFFF
111	.long m_read32_vdp # 0xC00000 - 0xC7FFFF
112	.long m_read32_vdp # 0xC80000 - 0xCFFFFF
113	.long m_read32_vdp # 0xD00000 - 0xD7FFFF
114	.long m_read32_vdp # 0xD80000 - 0xDFFFFF
115	.long m_read32_ram # 0xE00000 - 0xE7FFFF
116	.long m_read32_ram # 0xE80000 - 0xEFFFFF
117	.long m_read32_ram # 0xF00000 - 0xF7FFFF
118	.long m_read32_ram # 0xF80000 - 0xFFFFFF
119
120
121	# #############################################################################
122
123	.bss
124	.align 4
125
126	# used tables
127	m_read8_table:
128	.skip 32*4
129
130	m_read16_table:
131	.skip 32*4
132
133	m_read32_table:
134	.skip 32*4
135
136
137	# #############################################################################
138
139	.text
140	.align 4
141
142	.global PicoMemReset
143	.global PicoRead8
144	.global PicoRead16
145	.global PicoRead32
146	.global PicoWriteRomHW_SSF2
147
148	.global m_read8_def_table
149	.global m_read8_table
150
151	.macro PicoMemResetCopyDef dst_table src_table
152	lui $t0, %hi(\dst_table)
153	addiu $t0, %lo(\dst_table)
154	lui $t1, %hi(\src_table)
155	addiu $t1, %lo(\src_table)
156	li $t2, 32
157	1:
158	lw $t3, 0($t1)
159	sw $t3, 0($t0)
160	addiu $t2, -1
161	addiu $t1, 4
162	bnez $t2, 1b
163	addiu $t0, 4
164	.endm
165
166	# $t4 = 4
167	.macro PicoMemResetRomArea dst_table ar_label
168	lui $t0, %hi(\dst_table)
169	addiu $t0, %lo(\dst_table)
170	lui $t1, %hi(\ar_label)
171	addiu $t1, %lo(\ar_label)
172	li $t2, 20
173	1:
174	beq $t2, $v1, 2f
175	addiu $t2, -1
176	sll $t3, $t2, 2
177	beq $t2, $t4, 1b # do not touch the SRAM area
178	addu $t3, $t0
179	j 1b
180	sw $t1, 0($t3)
181	2:
182	.endm
183
184
185	PicoMemReset:
186	lui $v1, %hi(Pico+0x22204)
187	lw $v1, %lo(Pico+0x22204)($v1) # romsize
188	lui $t0, 8
189	addu $v1, $t0
190	addiu $v1, -1
191	srl $v1, 19
192
193	PicoMemResetCopyDef m_read8_table m_read8_def_table
194	PicoMemResetCopyDef m_read16_table m_read16_def_table
195	PicoMemResetCopyDef m_read32_table m_read32_def_table
196
197	# update memhandlers according to ROM size
198	li $t4, 4
199	PicoMemResetRomArea m_read8_table m_read8_above_rom
200	PicoMemResetRomArea m_read16_table m_read16_above_rom
201	PicoMemResetRomArea m_read32_table m_read32_above_rom
202
203	jr $ra
204	nop
205
206	# #############################################################################
207
208	.macro PicoReadJump table
209	lui $t0, %hi(\table)
210	srl $t1, $a0, 19
211	ins $t0, $t1, 2, 5
212	lw $t0, %lo(\table)($t0)
213	ins $a0, $0, 24, 8
214	jr $t0
215	nop
216	.endm
217
218	PicoRead8: # u32 a
219	PicoReadJump m_read8_table
220
221	PicoRead16: # u32 a
222	PicoReadJump m_read16_table
223
224	PicoRead32: # u32 a
225	PicoReadJump m_read32_table
226
227	# #############################################################################
228
229	m_read_null:
230	jr $ra
231	li $v0, 0
232
233	m_read_neg1:
234	jr $ra
235	addiu $v0, $0, 0xffff
236
237	# loads &Pico.rom to $t3
238	.macro m_read_rom_try_sram is200000 size
239	lui $t2, %hi(SRam)
240	addiu $t2, %lo(SRam)
241	lui $t3, %hi(Pico+0x22200)
242	lw $t1, 8($t2) # SRam.end
243	.if \is200000
244	ins $a0, $0, 19, 13
245	lui $t4, 0x20
246	or $a0, $t4
247	.endif
248	subu $t4, $a0, $t1
249	bgtz $t4, 1f
250	addiu $t3, %lo(Pico+0x22200)
251	lw $t1, 4($t2) # SRam.start
252	subu $t4, $t1, $a0
253	bgtz $t4, 1f
254	nop
255	lb $t1, 0x11($t3) # Pico.m.sram_reg
256	andi $t4, $t1, 5
257	beqz $t4, 1f
258	nop
259	.if \size == 8
260	j SRAMRead
261	nop
262	.elseif \size == 16
9dc09829	263	sw $ra, -4($sp)
9dc09829	264	jal SRAMRead16
3ec29f01	265	addiu $sp, -4
3ec29f01	266	lw $ra, 0($sp)
3ec29f01	267	jr $ra
9dc09829	268	addiu $sp, 4
3ec29f01	269	.else
3ec29f01	270	addiu $sp, -8
3ec29f01	271	sw $ra, 0($sp)
9dc09829	272	sw $a0, 4($sp)
	273	jal SRAMRead16
	274	nop
3ec29f01	275	lw $a0, 4($sp)
3ec29f01	276	sw $v0, 4($sp)
9dc09829	277	jal SRAMRead16
3ec29f01	278	addiu $a0, 2
	279	lw $v1, 4($sp)
	280	lw $ra, 0($sp)
	281	addiu $sp, 8
3ec29f01	282	jr $ra
9dc09829	283	ins $v0, $v1, 16, 16
3ec29f01	284	.endif
	285	# m_read_nosram:
	286	1:
	287	.endm
	288
	289	.macro m_read8_rom sect
	290	lui $t0, %hi(Pico+0x22200)
	291	lw $t0, %lo(Pico+0x22200)($t0) # rom
	292	xori $a0, 1
	293	ins $a0, $0, 19, 13
	294	.if \sect
	295	lui $t1, 8*\sect
	296	addu $a0, $t1
	297	.endif
	298	addu $t0, $a0
	299	jr $ra
	300	lb $v0, 0($t0)
	301	.endm
	302
	303
	304	m_read8_rom0: # 0x000000 - 0x07ffff
	305	m_read8_rom 0
	306
	307	m_read8_rom1: # 0x080000 - 0x0fffff
	308	m_read8_rom 1
	309
	310	m_read8_rom2: # 0x100000 - 0x17ffff
	311	m_read8_rom 2
	312
	313	m_read8_rom3: # 0x180000 - 0x1fffff
	314	m_read8_rom 3
	315
	316	m_read8_rom4: # 0x200000 - 0x27ffff, SRAM area
	317	m_read_rom_try_sram 1 8
	318	lw $t1, 4($t3) # romsize
	319	subu $t4, $t1, $a0
	320	blez $t4, m_read_null
	321	lw $t1, 0($t3) # rom
	322	xori $a0, 1
	323	addu $t1, $a0
	324	jr $ra
	325	lb $v0, 0($t1)
	326
	327	m_read8_rom5: # 0x280000 - 0x2fffff
	328	m_read8_rom 5
	329
	330	m_read8_rom6: # 0x300000 - 0x37ffff
	331	m_read8_rom 6
	332
	333	m_read8_rom7: # 0x380000 - 0x3fffff
	334	m_read8_rom 7
	335
	336	m_read8_rom8: # 0x400000 - 0x47ffff
	337	m_read8_rom 8
	338
	339	m_read8_rom9: # 0x480000 - 0x4fffff
	340	m_read8_rom 9
	341
	342	m_read8_romA: # 0x500000 - 0x57ffff
	343	m_read8_rom 0xA
	344
	345	m_read8_romB: # 0x580000 - 0x5fffff
	346	m_read8_rom 0xB
	347
348	m_read8_romC: # 0x600000 - 0x67ffff
349	m_read8_rom 0xC
350
351	m_read8_romD: # 0x680000 - 0x6fffff
352	m_read8_rom 0xD
353
354	m_read8_romE: # 0x700000 - 0x77ffff
355	m_read8_rom 0xE
356
357	m_read8_romF: # 0x780000 - 0x7fffff
358	m_read8_rom 0xF
359
360	m_read8_rom10: # 0x800000 - 0x87ffff
361	m_read8_rom 0x10
362
363	m_read8_rom11: # 0x880000 - 0x8fffff
364	m_read8_rom 0x11
365
366	m_read8_rom12: # 0x900000 - 0x97ffff
367	m_read8_rom 0x12
368
369	m_read8_rom13: # 0x980000 - 0x9fffff
370	m_read8_rom 0x13
371
372
373	m_read8_misc:
374	srl $t0, $a0, 5
375	sll $t0, $t0, 5
376	lui $t1, 0xa1
377	bne $t0, $t1, m_read8_misc2
378	andi $t0, $a0, 0x1e
379	m_read8_misc_io:
380	beqz $t0, m_read8_misc_hwreg
381	sub $t1, $t0, 4
382	bgtz $t1, m_read8_misc_ioports
383	nop
384	slti $a0, $t0, 4
385	xori $a0, 1
386	j PadRead
387	nop
388
389	m_read8_misc_hwreg:
390	lui $v0, %hi(Pico+0x2220f)
391	jr $ra
392	lb $v0, %lo(Pico+0x2220f)($v0)
393
394	m_read8_misc_ioports:
395	lui $v0, %hi(Pico+0x22000)
396	ins $v0, $t0, 0, 5
397	jr $ra
398	lb $v0, %lo(Pico+0x22000)($v0)
399
400	m_read8_misc2:
401	lui $t0, 0xa1
402	ori $t0, 0x1100
403	bne $a0, $t0, m_read8_misc3
404	srl $t0, $a0, 16
405	j z80ReadBusReq
406
407	m_read8_misc3:
408	addiu $t0, 0xff60 # expecting 0xa0 to get 0
409	bnez $t0, m_read8_misc4
410
411	# z80 area
412	andi $t0, $a0, 0x4000
413	bnez $t0, m_read8_z80_misc
414	andi $t0, $a0, 0x6000
415	j z80Read8 # z80 RAM
416
417	m_read8_z80_misc:
418	addiu $t0, 0xc000 # expecting 0x4000 to get 0
419	bnez $t0, m_read_neg1 # invalid
420
421	lui $t0, %hi(PicoOpt)
422	lw $t0, %lo(PicoOpt)($t0)
423	andi $t0, 1
43e6eaad	424	bnez $t0, ym2612_read_local_68k
43e6eaad	425	nop
3ec29f01	426
	427	m_read8_fake_ym2612:
	428	lb $v0, %lo(Pico+0x22208)($t0) # Pico.m.rotate
	429	addiu $t1, $v0, 1
	430	jr $ra
	431	sb $t1, %lo(Pico+0x22208)($t0)
	432
	433	# delay slot friendly
0ffefdb8	434	.macro m_read8_call16 funcname is_func_ptr=0
	435	.if \is_func_ptr
	436	lui $t1, %hi(\funcname)
	437	lw $t1, %lo(\funcname)($t1)
	438	.endif
3ec29f01	439	andi $t0, $a0, 1
	440	beqz $t0, 1f
	441	li $a1, 8 # not always needed, but shouln't cause problems
0ffefdb8	442	.if \is_func_ptr
	443	jr $t1
	444	.else
3ec29f01	445	j \funcname # odd address
0ffefdb8	446	.endif
3ec29f01	447	nop
	448	1:
	449	addiu $sp, -4
	450	sw $ra, 0($sp)
0ffefdb8	451	.if \is_func_ptr
	452	jalr $t1
	453	.else
3ec29f01	454	jal \funcname
0ffefdb8	455	.endif
3ec29f01	456	xori $a0, 1
	457	lw $ra, 0($sp)
	458	addiu $sp, 4
	459	jr $ra
	460	srl $v0, 8
	461	.endm
	462
	463	m_read8_misc4:
	464	# if everything else fails, use generic handler
	465	m_read8_call16 OtherRead16
	466
	467	m_read8_vdp:
	468	ext $t0, $a0, 16, 3
	469	andi $t1, $a0, 0xe0
	470	or $t0, $t1
	471	bnez $t0, m_read_null # invalid address
	472	m_read8_call16 PicoVideoRead
	473
	474	m_read8_ram:
	475	lui $t0, %hi(Pico)
	476	ins $t0, $a0, 0, 16
	477	xori $t0, 1
	478	jr $ra
	479	lb $v0, %lo(Pico)($t0)
	480
	481	m_read8_above_rom:
	482	# might still be SRam (Micro Machines, HardBall '95)
	483	m_read_rom_try_sram 0 8
0ffefdb8	484	m_read8_call16 PicoRead16Hook 1
3ec29f01	485
	486	# #############################################################################
	487
	488	.macro m_read16_rom sect
	489	lui $t0, %hi(Pico+0x22200)
	490	lw $t0, %lo(Pico+0x22200)($t0) # rom
	491	ins $a0, $0, 0, 1
	492	ins $a0, $0, 19, 13
	493	.if \sect
	494	lui $t1, 8*\sect
	495	addu $a0, $t1
	496	.endif
	497	addu $t0, $a0
	498	jr $ra
	499	lh $v0, 0($t0)
	500	.endm
	501
	502
	503	m_read16_rom0: # 0x000000 - 0x07ffff
	504	m_read16_rom 0
	505
	506	m_read16_rom1: # 0x080000 - 0x0fffff
	507	m_read16_rom 1
	508
	509	m_read16_rom2: # 0x100000 - 0x17ffff
	510	m_read16_rom 2
	511
	512	m_read16_rom3: # 0x180000 - 0x1fffff
	513	m_read16_rom 3
	514
	515	m_read16_rom4: # 0x200000 - 0x27ffff, SRAM area
	516	m_read_rom_try_sram 1 16
	517	lw $t1, 4($t3) # romsize
	518	subu $t4, $t1, $a0
	519	blez $t4, m_read_null
	520	lw $t1, 0($t3) # rom
	521	ins $a0, $0, 0, 1
	522	addu $t1, $a0
	523	jr $ra
	524	lh $v0, 0($t1)
	525
	526	m_read16_rom5: # 0x280000 - 0x2fffff
	527	m_read16_rom 5
	528
	529	m_read16_rom6: # 0x300000 - 0x37ffff
	530	m_read16_rom 6
	531
	532	m_read16_rom7: # 0x380000 - 0x3fffff
	533	m_read16_rom 7
	534
	535	m_read16_rom8: # 0x400000 - 0x47ffff
	536	m_read16_rom 8
	537
	538	m_read16_rom9: # 0x480000 - 0x4fffff
	539	m_read16_rom 9
	540
	541	m_read16_romA: # 0x500000 - 0x57ffff
	542	m_read16_rom 0xA
	543
	544	m_read16_romB: # 0x580000 - 0x5fffff
	545	m_read16_rom 0xB
	546
	547	m_read16_romC: # 0x600000 - 0x67ffff
	548	m_read16_rom 0xC
549
550	m_read16_romD: # 0x680000 - 0x6fffff
551	m_read16_rom 0xD
552
553	m_read16_romE: # 0x700000 - 0x77ffff
554	m_read16_rom 0xE
555
556	m_read16_romF: # 0x780000 - 0x7fffff
557	m_read16_rom 0xF
558
559	m_read16_rom10: # 0x800000 - 0x87ffff
560	m_read16_rom 0x10
561
562	m_read16_rom11: # 0x880000 - 0x8fffff
563	m_read16_rom 0x11
564
565	m_read16_rom12: # 0x900000 - 0x97ffff
566	m_read16_rom 0x12
567
568	m_read16_rom13: # 0x980000 - 0x9fffff
569	m_read16_rom 0x13
570
571	m_read16_misc:
572	ins $a0, $0, 0, 1
573	j OtherRead16
574	li $a1, 16
575
576	m_read16_vdp:
577	ext $t0, $a0, 16, 3
578	andi $t1, $a0, 0xe0
579	or $t0, $t1
580	bnez $t0, m_read_null # invalid address
581	ins $a0, $0, 0, 1
582	j PicoVideoRead
583	nop
584
585	m_read16_ram:
586	lui $t0, %hi(Pico)
587	ins $a0, $0, 0, 1
588	ins $t0, $a0, 0, 16
589	jr $ra
590	lh $v0, %lo(Pico)($t0)
591
592	m_read16_above_rom:
593	# might still be SRam
594	m_read_rom_try_sram 0 16
0ffefdb8	595	lui $t1, %hi(PicoRead16Hook)
	596	lw $t1, %lo(PicoRead16Hook)($t1)
	597	jr $t1
3ec29f01	598	ins $a0, $0, 0, 1
	599
	600	# #############################################################################
	601
	602	.macro m_read32_rom sect
	603	lui $t0, %hi(Pico+0x22200)
	604	lw $t0, %lo(Pico+0x22200)($t0) # rom
	605	ins $a0, $0, 0, 1
	606	ins $a0, $0, 19, 13
	607	.if \sect
	608	lui $t1, 8*\sect
	609	addu $a0, $t1
	610	.endif
	611	addu $t0, $a0
	612	lh $v1, 0($t0)
	613	lh $v0, 2($t0)
	614	jr $ra
	615	ins $v0, $v1, 16, 16
	616	.endm
	617
	618
	619	m_read32_rom0: # 0x000000 - 0x07ffff
	620	m_read32_rom 0
	621
	622	m_read32_rom1: # 0x080000 - 0x0fffff
	623	m_read32_rom 1
	624
	625	m_read32_rom2: # 0x100000 - 0x17ffff
	626	m_read32_rom 2
	627
	628	m_read32_rom3: # 0x180000 - 0x1fffff
	629	m_read32_rom 3
	630
	631	m_read32_rom4: # 0x200000 - 0x27ffff, SRAM area
	632	m_read_rom_try_sram 1 32
	633	lw $t1, 4($t3) # romsize
	634	subu $t4, $t1, $a0
	635	blez $t4, m_read_null
	636	lw $t1, 0($t3) # rom
	637	ins $a0, $0, 0, 1
	638	addu $t1, $a0
	639	lh $v1, 0($t1)
	640	lh $v0, 2($t1)
	641	jr $ra
	642	ins $v0, $v1, 16, 16
	643
	644	m_read32_rom5: # 0x280000 - 0x2fffff
	645	m_read32_rom 5
	646
	647	m_read32_rom6: # 0x300000 - 0x37ffff
	648	m_read32_rom 6
	649
	650	m_read32_rom7: # 0x380000 - 0x3fffff
	651	m_read32_rom 7
	652
	653	m_read32_rom8: # 0x400000 - 0x47ffff
	654	m_read32_rom 8
	655
	656	m_read32_rom9: # 0x480000 - 0x4fffff
	657	m_read32_rom 9
	658
	659	m_read32_romA: # 0x500000 - 0x57ffff
	660	m_read32_rom 0xA
	661
662	m_read32_romB: # 0x580000 - 0x5fffff
663	m_read32_rom 0xB
664
665	m_read32_romC: # 0x600000 - 0x67ffff
666	m_read32_rom 0xC
667
668	m_read32_romD: # 0x680000 - 0x6fffff
669	m_read32_rom 0xD
670
671	m_read32_romE: # 0x700000 - 0x77ffff
672	m_read32_rom 0xE
673
674	m_read32_romF: # 0x780000 - 0x7fffff
675	m_read32_rom 0xF
676
677	m_read32_rom10: # 0x800000 - 0x87ffff
678	m_read32_rom 0x10
679
680	m_read32_rom11: # 0x880000 - 0x8fffff
681	m_read32_rom 0x11
682
683	m_read32_rom12: # 0x900000 - 0x97ffff
684	m_read32_rom 0x12
685
686	m_read32_rom13: # 0x980000 - 0x9fffff
687	m_read32_rom 0x13
688
689	.macro m_read32_call16 func need_a1=0
690	addiu $sp, -8
691	sw $ra, 0($sp)
692	sw $s0, 4($sp)
693	.if \need_a1
694	li $a1, 16
695	.endif
696	jal \func
697	move $s0, $a0
698
699	addu $a0, $s0, 2
700	.if \need_a1
701	li $a1, 16
702	.endif
703	jal \func
704	move $s0, $v0
705
706	ins $v0, $s0, 16, 16
707	lw $ra, 0($sp)
708	lw $s0, 4($sp)
709	jr $ra
710	addiu $sp, 8
711	.endm
712
713	m_read32_misc:
714	ins $a0, $0, 0, 1
715	m_read32_call16 OtherRead16, 1
716
717	m_read32_vdp:
718	ext $t0, $a0, 16, 3
719	andi $t1, $a0, 0xe0
720	or $t0, $t1
721	bnez $t0, m_read_null # invalid address
722	ins $a0, $0, 0, 1
723	m_read32_call16 PicoVideoRead
724
725	m_read32_ram:
726	lui $t0, %hi(Pico)
727	ins $a0, $0, 0, 1
728	ins $t0, $a0, 0, 16
729	lh $v1, %lo(Pico)($t0)
730	lh $v0, %lo(Pico+2)($t0)
731	jr $ra
732	ins $v0, $v1, 16, 16
733
734	m_read32_above_rom:
735	# might still be SRam
736	m_read_rom_try_sram 0 32
737	ins $a0, $0, 0, 1
0ffefdb8	738	lui $t1, %hi(PicoRead16Hook)
	739	lw $t1, %lo(PicoRead16Hook)($t1)
	740	addiu $sp, -4*3
	741	sw $ra, 0($sp)
	742	sw $s0, 4($sp)
	743	sw $t1, 8($sp)
	744	jalr $t1
	745	move $s0, $a0
	746
	747	lw $t1, 8($sp)
	748	addu $a0, $s0, 2
	749	jalr $t1
	750	move $s0, $v0
	751
	752	ins $v0, $s0, 16, 16
	753	lw $ra, 0($sp)
	754	lw $s0, 4($sp)
	755	jr $ra
	756	addiu $sp, 4*3
3ec29f01	757
	758	# #############################################################################
	759
	760	.macro PicoWriteRomHW_SSF2_ls def_table table
	761	lui $t3, %hi(\def_table)
	762	ins $t3, $a1, 2, 5
	763	lw $t0, %lo(\def_table)($t3)
	764	lui $t2, %hi(\table)
	765	ins $t2, $a0, 2, 3
	766	sw $t0, %lo(\table)($t2)
	767	.endm
	768
	769	PicoWriteRomHW_SSF2: # u32 a, u32 d
	770	ext $a0, $a0, 1, 3
	771	bnez $a0, pwr_banking
	772
	773	# sram register
	774	lui $t0, %hi(Pico+0x22211)
	775	lb $t1, %lo(Pico+0x22211)($t0) # Pico.m.sram_reg
	776	ins $t1, $a1, 0, 2
	777	jr $ra
	778	sb $t1, %lo(Pico+0x22211)($t0)
	779
	780	pwr_banking:
	781	andi $a1, 0x1f
	782
	783	PicoWriteRomHW_SSF2_ls m_read8_def_table m_read8_table
	784	PicoWriteRomHW_SSF2_ls m_read16_def_table m_read16_table
	785	PicoWriteRomHW_SSF2_ls m_read32_def_table m_read32_table
	786
	787	jr $ra
	788	nop
	789