Memory_amips.s

   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
 263     sw      $ra, -4($sp)
 264     jal     SRAMRead16
 265     addiu   $sp, -4
 266     lw      $ra, 0($sp)
 267     jr      $ra
 268     addiu   $sp, 4
 269 .else
 270     addiu   $sp, -8
 271     sw      $ra, 0($sp)
 272     sw      $a0, 4($sp)
 273     jal     SRAMRead16
 274     nop
 275     lw      $a0, 4($sp)
 276     sw      $v0, 4($sp)
 277     jal     SRAMRead16
 278     addiu   $a0, 2
 279     lw      $v1, 4($sp)
 280     lw      $ra, 0($sp)
 281     addiu   $sp, 8
 282     jr      $ra
 283     ins     $v0, $v1, 16, 16
 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
 424     bnez    $t0, ym2612_read_local_68k
 425     nop
 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
 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
 439     andi    $t0, $a0, 1
 440     beqz    $t0, 1f
 441     li      $a1, 8      # not always needed, but shouln't cause problems
 442 .if \is_func_ptr
 443     jr      $t1
 444 .else
 445     j       \funcname   # odd address
 446 .endif
 447     nop
 448 1:
 449     addiu   $sp, -4
 450     sw      $ra, 0($sp)
 451 .if \is_func_ptr
 452     jalr    $t1
 453 .else
 454     jal     \funcname
 455 .endif
 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
 484     m_read8_call16 PicoRead16Hook 1
 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
 595     lui     $t1, %hi(PicoRead16Hook)
 596     lw      $t1, %lo(PicoRead16Hook)($t1)
 597     jr      $t1
 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
 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
 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