5a6b7681fc4bb3db4b7e4329d9913557d60fd83f
[picodrive.git] / 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