Pico/Memory.s

   1 @ vim:filetype=armasm\r
   2 \r
   3 @ memory handlers with banking support for SSF II - The New Challengers\r
   4 @ mostly based on Gens code\r
   5 \r
   6 @ (c) Copyright 2006-2007, Grazvydas "notaz" Ignotas\r
   7 @ All Rights Reserved\r
   8 \r
   9 \r
  10 .include "port_config.s"\r
  11 \r
  12 .text\r
  13 .align 4\r
  14 \r
  15 @ default jump tables\r
  16 \r
  17 m_read8_def_table:\r
  18     .long   m_read8_rom0    @ 0x000000 - 0x07FFFF\r
  19     .long   m_read8_rom1    @ 0x080000 - 0x0FFFFF\r
  20     .long   m_read8_rom2    @ 0x100000 - 0x17FFFF\r
  21     .long   m_read8_rom3    @ 0x180000 - 0x1FFFFF\r
  22     .long   m_read8_rom4    @ 0x200000 - 0x27FFFF\r
  23     .long   m_read8_rom5    @ 0x280000 - 0x2FFFFF\r
  24     .long   m_read8_rom6    @ 0x300000 - 0x37FFFF\r
  25     .long   m_read8_rom7    @ 0x380000 - 0x3FFFFF\r
  26     .long   m_read8_rom8    @ 0x400000 - 0x47FFFF - for all those large ROM hacks\r
  27     .long   m_read8_rom9    @ 0x480000 - 0x4FFFFF\r
  28     .long   m_read8_romA    @ 0x500000 - 0x57FFFF\r
  29     .long   m_read8_romB    @ 0x580000 - 0x5FFFFF\r
  30     .long   m_read8_romC    @ 0x600000 - 0x67FFFF\r
  31     .long   m_read8_romD    @ 0x680000 - 0x6FFFFF\r
  32     .long   m_read8_romE    @ 0x700000 - 0x77FFFF\r
  33     .long   m_read8_romF    @ 0x780000 - 0x7FFFFF\r
  34     .long   m_read8_rom10   @ 0x800000 - 0x87FFFF\r
  35     .long   m_read8_rom11   @ 0x880000 - 0x8FFFFF\r
  36     .long   m_read8_rom12   @ 0x900000 - 0x97FFFF\r
  37     .long   m_read8_rom13   @ 0x980000 - 0x9FFFFF\r
  38     .long   m_read8_misc    @ 0xA00000 - 0xA7FFFF\r
  39     .long   m_read_null     @ 0xA80000 - 0xAFFFFF\r
  40     .long   m_read_null     @ 0xB00000 - 0xB7FFFF\r
  41     .long   m_read_null     @ 0xB80000 - 0xBFFFFF\r
  42     .long   m_read8_vdp     @ 0xC00000 - 0xC7FFFF\r
  43     .long   m_read8_vdp     @ 0xC80000 - 0xCFFFFF\r
  44     .long   m_read8_vdp     @ 0xD00000 - 0xD7FFFF\r
  45     .long   m_read8_vdp     @ 0xD80000 - 0xDFFFFF\r
  46     .long   m_read8_ram     @ 0xE00000 - 0xE7FFFF\r
  47     .long   m_read8_ram     @ 0xE80000 - 0xEFFFFF\r
  48     .long   m_read8_ram     @ 0xF00000 - 0xF7FFFF\r
  49     .long   m_read8_ram     @ 0xF80000 - 0xFFFFFF\r
  50 \r
  51 m_read16_def_table:\r
  52     .long   m_read16_rom0    @ 0x000000 - 0x07FFFF\r
  53     .long   m_read16_rom1    @ 0x080000 - 0x0FFFFF\r
  54     .long   m_read16_rom2    @ 0x100000 - 0x17FFFF\r
  55     .long   m_read16_rom3    @ 0x180000 - 0x1FFFFF\r
  56     .long   m_read16_rom4    @ 0x200000 - 0x27FFFF\r
  57     .long   m_read16_rom5    @ 0x280000 - 0x2FFFFF\r
  58     .long   m_read16_rom6    @ 0x300000 - 0x37FFFF\r
  59     .long   m_read16_rom7    @ 0x380000 - 0x3FFFFF\r
  60     .long   m_read16_rom8    @ 0x400000 - 0x47FFFF\r
  61     .long   m_read16_rom9    @ 0x480000 - 0x4FFFFF\r
  62     .long   m_read16_romA    @ 0x500000 - 0x57FFFF\r
  63     .long   m_read16_romB    @ 0x580000 - 0x5FFFFF\r
  64     .long   m_read16_romC    @ 0x600000 - 0x67FFFF\r
  65     .long   m_read16_romD    @ 0x680000 - 0x6FFFFF\r
  66     .long   m_read16_romE    @ 0x700000 - 0x77FFFF\r
  67     .long   m_read16_romF    @ 0x780000 - 0x7FFFFF\r
  68     .long   m_read16_rom10   @ 0x800000 - 0x87FFFF\r
  69     .long   m_read16_rom11   @ 0x880000 - 0x8FFFFF\r
  70     .long   m_read16_rom12   @ 0x900000 - 0x97FFFF\r
  71     .long   m_read16_rom13   @ 0x980000 - 0x9FFFFF\r
  72     .long   m_read16_misc    @ 0xA00000 - 0xA7FFFF\r
  73     .long   m_read_null      @ 0xA80000 - 0xAFFFFF\r
  74     .long   m_read_null      @ 0xB00000 - 0xB7FFFF\r
  75     .long   m_read_null      @ 0xB80000 - 0xBFFFFF\r
  76     .long   m_read16_vdp     @ 0xC00000 - 0xC7FFFF\r
  77     .long   m_read16_vdp     @ 0xC80000 - 0xCFFFFF\r
  78     .long   m_read16_vdp     @ 0xD00000 - 0xD7FFFF\r
  79     .long   m_read16_vdp     @ 0xD80000 - 0xDFFFFF\r
  80     .long   m_read16_ram     @ 0xE00000 - 0xE7FFFF\r
  81     .long   m_read16_ram     @ 0xE80000 - 0xEFFFFF\r
  82     .long   m_read16_ram     @ 0xF00000 - 0xF7FFFF\r
  83     .long   m_read16_ram     @ 0xF80000 - 0xFFFFFF\r
  84 \r
  85 m_read32_def_table:\r
  86     .long   m_read32_rom0    @ 0x000000 - 0x07FFFF\r
  87     .long   m_read32_rom1    @ 0x080000 - 0x0FFFFF\r
  88     .long   m_read32_rom2    @ 0x100000 - 0x17FFFF\r
  89     .long   m_read32_rom3    @ 0x180000 - 0x1FFFFF\r
  90     .long   m_read32_rom4    @ 0x200000 - 0x27FFFF\r
  91     .long   m_read32_rom5    @ 0x280000 - 0x2FFFFF\r
  92     .long   m_read32_rom6    @ 0x300000 - 0x37FFFF\r
  93     .long   m_read32_rom7    @ 0x380000 - 0x3FFFFF\r
  94     .long   m_read32_rom8    @ 0x400000 - 0x47FFFF\r
  95     .long   m_read32_rom9    @ 0x480000 - 0x4FFFFF\r
  96     .long   m_read32_romA    @ 0x500000 - 0x57FFFF\r
  97     .long   m_read32_romB    @ 0x580000 - 0x5FFFFF\r
  98     .long   m_read32_romC    @ 0x600000 - 0x67FFFF\r
  99     .long   m_read32_romD    @ 0x680000 - 0x6FFFFF\r
 100     .long   m_read32_romE    @ 0x700000 - 0x77FFFF\r
 101     .long   m_read32_romF    @ 0x780000 - 0x7FFFFF\r
 102     .long   m_read32_rom10   @ 0x800000 - 0x87FFFF\r
 103     .long   m_read32_rom11   @ 0x880000 - 0x8FFFFF\r
 104     .long   m_read32_rom12   @ 0x900000 - 0x97FFFF\r
 105     .long   m_read32_rom13   @ 0x980000 - 0x9FFFFF\r
 106     .long   m_read32_misc    @ 0xA00000 - 0xA7FFFF\r
 107     .long   m_read_null      @ 0xA80000 - 0xAFFFFF\r
 108     .long   m_read_null      @ 0xB00000 - 0xB7FFFF\r
 109     .long   m_read_null      @ 0xB80000 - 0xBFFFFF\r
 110     .long   m_read32_vdp     @ 0xC00000 - 0xC7FFFF\r
 111     .long   m_read32_vdp     @ 0xC80000 - 0xCFFFFF\r
 112     .long   m_read32_vdp     @ 0xD00000 - 0xD7FFFF\r
 113     .long   m_read32_vdp     @ 0xD80000 - 0xDFFFFF\r
 114     .long   m_read32_ram     @ 0xE00000 - 0xE7FFFF\r
 115     .long   m_read32_ram     @ 0xE80000 - 0xEFFFFF\r
 116     .long   m_read32_ram     @ 0xF00000 - 0xF7FFFF\r
 117     .long   m_read32_ram     @ 0xF80000 - 0xFFFFFF\r
 118 \r
 119 \r
 120 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 121 \r
 122 .bss\r
 123 .align 4\r
 124 @.section .bss, "brw"\r
 125 @.data\r
 126 \r
 127 @ used tables\r
 128 m_read8_table:\r
 129     .skip 32*4\r
 130 \r
 131 m_read16_table:\r
 132     .skip 32*4\r
 133 \r
 134 m_read32_table:\r
 135     .skip 32*4\r
 136 \r
 137 \r
 138 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 139 \r
 140 .text\r
 141 .align 4\r
 142 \r
 143 .global PicoMemReset\r
 144 .global PicoRead8\r
 145 .global PicoRead16\r
 146 .global PicoRead32\r
 147 .global PicoWrite8\r
 148 .global PicoWriteRomHW_SSF2\r
 149 .global m_m68k_read8_misc\r
 150 .global m_m68k_write8_misc\r
 151 \r
 152 \r
 153 PicoMemReset:\r
 154     ldr     r12,=(Pico+0x22204)\r
 155     ldr     r12,[r12]                @ romsize\r
 156     add     r12,r12,#0x80000\r
 157     sub     r12,r12,#1\r
 158     mov     r12,r12,lsr #19\r
 159 \r
 160     ldr     r0, =m_read8_table\r
 161     ldr     r1, =m_read8_def_table\r
 162     mov     r2, #32\r
 163 1:\r
 164     ldr     r3, [r1], #4\r
 165     str     r3, [r0], #4\r
 166     subs    r2, r2, #1\r
 167     bne     1b\r
 168 \r
 169     ldr     r0, =m_read16_table\r
 170     ldr     r1, =m_read16_def_table\r
 171     mov     r2, #32\r
 172 1:\r
 173     subs    r2, r2, #1\r
 174     ldr     r3, [r1], #4\r
 175     str     r3, [r0], #4\r
 176     bne     1b\r
 177 \r
 178     ldr     r0, =m_read32_table\r
 179     ldr     r1, =m_read32_def_table\r
 180     mov     r2, #32\r
 181 1:\r
 182     subs    r2, r2, #1\r
 183     ldr     r3, [r1], #4\r
 184     str     r3, [r0], #4\r
 185     bne     1b\r
 186 \r
 187     @ update memhandlers according to ROM size\r
 188     ldr     r1, =m_read8_above_rom\r
 189     ldr     r0, =m_read8_table\r
 190     mov     r2, #20\r
 191 1:\r
 192     sub     r2, r2, #1\r
 193     cmp     r2, r12\r
 194     blt     2f\r
 195     cmp     r2, #4\r
 196     beq     1b                      @ do not touch the SRAM area\r
 197     str     r1, [r0, r2, lsl #2]\r
 198     b       1b\r
 199 2:\r
 200     ldr     r1, =m_read16_above_rom\r
 201     ldr     r0, =m_read16_table\r
 202     mov     r2, #20\r
 203 1:\r
 204     sub     r2, r2, #1\r
 205     cmp     r2, r12\r
 206     blt     2f\r
 207     cmp     r2, #4\r
 208     beq     1b\r
 209     str     r1, [r0, r2, lsl #2]\r
 210     b       1b\r
 211 2:\r
 212     ldr     r1, =m_read32_above_rom\r
 213     ldr     r0, =m_read32_table\r
 214     mov     r2, #20\r
 215 1:\r
 216     sub     r2, r2, #1\r
 217     cmp     r2, r12\r
 218     blt     2f\r
 219     cmp     r2, #4\r
 220     beq     1b\r
 221     str     r1, [r0, r2, lsl #2]\r
 222     b       1b\r
 223 2:\r
 224     bx      lr\r
 225 \r
 226 .pool\r
 227 \r
 228 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 229 \r
 230 PicoRead8: @ u32 a\r
 231     ldr     r2, =m_read8_table\r
 232     bic     r0, r0, #0xff000000\r
 233     and     r1, r0, #0x00f80000\r
 234     ldr     pc, [r2, r1, lsr #17]\r
 235 \r
 236 PicoRead16: @ u32 a\r
 237     ldr     r2, =m_read16_table\r
 238     bic     r0, r0, #0xff000000\r
 239     and     r1, r0, #0x00f80000\r
 240     ldr     pc, [r2, r1, lsr #17]\r
 241 \r
 242 PicoRead32: @ u32 a\r
 243     ldr     r2, =m_read32_table\r
 244     bic     r0, r0, #0xff000000\r
 245     and     r1, r0, #0x00f80000\r
 246     ldr     pc, [r2, r1, lsr #17]\r
 247 \r
 248 .pool\r
 249 \r
 250 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 251 \r
 252 m_read_null:\r
 253     mov     r0, #0\r
 254     bx      lr\r
 255 \r
 256 \r
 257 .macro m_read8_rom sect\r
 258     ldr     r1, =(Pico+0x22200)\r
 259     bic     r0, r0, #0xf80000\r
 260     ldr     r1, [r1]\r
 261 .if \sect\r
 262     orr     r0, r0, #0x080000*\sect\r
 263 .endif\r
 264     eor     r0, r0, #1\r
 265     ldrb    r0, [r1, r0]\r
 266     bx      lr\r
 267 .endm\r
 268 \r
 269 \r
 270 m_read8_rom0: @ 0x000000 - 0x07ffff\r
 271     m_read8_rom 0\r
 272 \r
 273 m_read8_rom1: @ 0x080000 - 0x0fffff\r
 274     m_read8_rom 1\r
 275 \r
 276 m_read8_rom2: @ 0x100000 - 0x17ffff\r
 277     m_read8_rom 2\r
 278 \r
 279 m_read8_rom3: @ 0x180000 - 0x1fffff\r
 280     m_read8_rom 3\r
 281 \r
 282 m_read8_rom4: @ 0x200000 - 0x27ffff, SRAM area\r
 283     ldr     r2, =(SRam)\r
 284     ldr     r3, =(Pico+0x22200)\r
 285     ldr     r1, [r2, #8]    @ SRam.end\r
 286     bic     r0, r0, #0xf80000\r
 287     orr     r0, r0, #0x200000\r
 288     cmp     r0, r1\r
 289     bgt     m_read8_nosram\r
 290     ldr     r1, [r2, #4]    @ SRam.start\r
 291     cmp     r0, r1\r
 292     blt     m_read8_nosram\r
 293     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg\r
 294     tst     r1, #5\r
 295     bne     SRAMRead\r
 296 m_read8_nosram:\r
 297     ldr     r1, [r3, #4]    @ romsize\r
 298     cmp     r0, r1\r
 299     movgt   r0, #0\r
 300     bxgt    lr              @ bad location\r
 301     ldr     r1, [r3]\r
 302     eor     r0, r0, #1\r
 303     ldrb    r0, [r1, r0]\r
 304     bx      lr\r
 305 \r
 306 m_read8_rom5: @ 0x280000 - 0x2fffff\r
 307     m_read8_rom 5\r
 308 \r
 309 m_read8_rom6: @ 0x300000 - 0x37ffff\r
 310     m_read8_rom 6\r
 311 \r
 312 m_read8_rom7: @ 0x380000 - 0x3fffff\r
 313     m_read8_rom 7\r
 314 \r
 315 m_read8_rom8: @ 0x400000 - 0x47ffff\r
 316     m_read8_rom 8\r
 317 \r
 318 m_read8_rom9: @ 0x480000 - 0x4fffff\r
 319     m_read8_rom 9\r
 320 \r
 321 m_read8_romA: @ 0x500000 - 0x57ffff\r
 322     m_read8_rom 0xA\r
 323 \r
 324 m_read8_romB: @ 0x580000 - 0x5fffff\r
 325     m_read8_rom 0xB\r
 326 \r
 327 m_read8_romC: @ 0x600000 - 0x67ffff\r
 328     m_read8_rom 0xC\r
 329 \r
 330 m_read8_romD: @ 0x680000 - 0x6fffff\r
 331     m_read8_rom 0xD\r
 332 \r
 333 m_read8_romE: @ 0x700000 - 0x77ffff\r
 334     m_read8_rom 0xE\r
 335 \r
 336 m_read8_romF: @ 0x780000 - 0x7fffff\r
 337     m_read8_rom 0xF\r
 338 \r
 339 m_read8_rom10: @ 0x800000 - 0x87ffff\r
 340     m_read8_rom 0x10\r
 341 \r
 342 m_read8_rom11: @ 0x880000 - 0x8fffff\r
 343     m_read8_rom 0x11\r
 344 \r
 345 m_read8_rom12: @ 0x900000 - 0x97ffff\r
 346     m_read8_rom 0x12\r
 347 \r
 348 m_read8_rom13: @ 0x980000 - 0x9fffff\r
 349     m_read8_rom 0x13\r
 350 \r
 351 \r
 352 m_m68k_read8_misc:\r
 353 m_read8_misc:\r
 354     bic     r2, r0, #0x001f @ most commonly we get i/o port read,\r
 355     cmp     r2, #0xa10000   @ so check for it first\r
 356     bne     m_read8_misc2\r
 357 m_read8_misc_io:\r
 358     ands    r0, r0, #0x1e\r
 359     beq     m_read8_misc_hwreg\r
 360     cmp     r0, #4\r
 361     movlt   r0, #0\r
 362     moveq   r0, #1\r
 363     ble     PadRead\r
 364     ldr     r3, =(Pico+0x22000)\r
 365     mov     r0, r0, lsr #1  @ other IO ports (Pico.ioports[a])\r
 366     ldrb    r0, [r3, r0]\r
 367     bx      lr\r
 368 \r
 369 m_read8_misc_hwreg:\r
 370     ldr     r3, =(Pico+0x22200)\r
 371     ldrb    r0, [r3, #0x0f] @ Pico.m.hardware\r
 372     bx      lr\r
 373 \r
 374 m_read8_misc2:\r
 375     mov     r2,     #0xa10000 @ games also like to poll busreq,\r
 376     orr     r2, r2, #0x001100 @ so we'll try it now\r
 377     cmp     r0, r2\r
 378     beq     z80ReadBusReq\r
 379 \r
 380     and     r2, r0, #0xff0000 @ finally it might be\r
 381     cmp     r2,     #0xa00000 @ z80 area\r
 382     bne     m_read8_misc3\r
 383     tst     r0, #0x4000\r
 384     beq     z80Read8          @ z80 RAM\r
 385     and     r2, r0, #0x6000\r
 386     cmp     r2, #0x4000\r
 387     mvnne   r0, #0\r
 388     bxne    lr                @ invalid\r
 389     ldr     r1, =PicoOpt\r
 390     ldr     r1, [r1]\r
 391     tst     r1, #1\r
 392     bne     ym2612_read_local_68k\r
 393 \r
 394 m_read8_fake_ym2612:\r
 395     ldr     r3, =(Pico+0x22200)\r
 396     ldrb    r0, [r3, #8]      @ Pico.m.rotate\r
 397     add     r1, r0, #1\r
 398     strb    r1, [r3, #8]\r
 399     and     r0, r0, #3\r
 400     bx      lr\r
 401 \r
 402 m_read8_misc3:\r
 403     @ if everything else fails, use generic handler\r
 404     stmfd   sp!,{r0,lr}\r
 405     bic     r0, r0, #1\r
 406     mov     r1, #8\r
 407     bl      OtherRead16\r
 408     ldmfd   sp!,{r1,lr}\r
 409     tst     r1, #1\r
 410     moveq   r0, r0, lsr #8\r
 411     bx      lr\r
 412 \r
 413 \r
 414 m_read8_vdp:\r
 415     tst     r0, #0x70000\r
 416     tsteq   r0, #0x000e0\r
 417     bxne    lr              @ invalid read\r
 418     stmfd   sp!,{r0,lr}\r
 419     bic     r0, r0, #1\r
 420     bl      PicoVideoRead\r
 421     ldmfd   sp!,{r1,lr}\r
 422     tst     r1, #1\r
 423     moveq   r0, r0, lsr #8\r
 424     bx      lr\r
 425 \r
 426 m_read8_ram:\r
 427     ldr     r1, =Pico\r
 428     bic     r0, r0, #0xff0000\r
 429     eor     r0, r0, #1\r
 430     ldrb    r0, [r1, r0]\r
 431     bx      lr\r
 432 \r
 433 m_read8_above_rom:\r
 434     @ might still be SRam (Micro Machines, HardBall '95)\r
 435     ldr     r2, =(SRam)\r
 436     ldr     r3, =(Pico+0x22200)\r
 437     ldr     r1, [r2, #8]    @ SRam.end\r
 438     cmp     r0, r1\r
 439     bgt     m_read8_ar_nosram\r
 440     ldr     r1, [r2, #4]    @ SRam.start\r
 441     cmp     r0, r1\r
 442     blt     m_read8_ar_nosram\r
 443     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg\r
 444     tst     r1, #5\r
 445     bne     SRAMRead\r
 446 m_read8_ar_nosram:\r
 447     ldr     r2, =PicoRead16Hook\r
 448     stmfd   sp!,{r0,lr}\r
 449     ldr     r2, [r2]\r
 450     bic     r0, r0, #1\r
 451     mov     r1, #8\r
 452     mov     lr, pc\r
 453     bx      r2\r
 454     ldmfd   sp!,{r1,lr}\r
 455     tst     r1, #1\r
 456     moveq   r0, r0, lsr #8\r
 457     bx      lr\r
 458 \r
 459 .pool\r
 460 \r
 461 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 462 \r
 463 .macro m_read16_rom sect\r
 464     ldr     r1, =(Pico+0x22200)\r
 465     bic     r0, r0, #0xf80000\r
 466     ldr     r1, [r1]\r
 467     bic     r0, r0, #1\r
 468 .if \sect\r
 469     orr     r0, r0, #0x080000*\sect\r
 470 .endif\r
 471     ldrh    r0, [r1, r0]\r
 472     bx      lr\r
 473 .endm\r
 474 \r
 475 \r
 476 m_read16_rom0: @ 0x000000 - 0x07ffff\r
 477     m_read16_rom 0\r
 478 \r
 479 m_read16_rom1: @ 0x080000 - 0x0fffff\r
 480     m_read16_rom 1\r
 481 \r
 482 m_read16_rom2: @ 0x100000 - 0x17ffff\r
 483     m_read16_rom 2\r
 484 \r
 485 m_read16_rom3: @ 0x180000 - 0x1fffff\r
 486     m_read16_rom 3\r
 487 \r
 488 m_read16_rom4: @ 0x200000 - 0x27ffff, SRAM area (NBA Live 95)\r
 489     ldr     r2, =(SRam)\r
 490     ldr     r3, =(Pico+0x22200)\r
 491     ldr     r1, [r2, #8]    @ SRam.end\r
 492     bic     r0, r0, #0xf80000\r
 493     bic     r0, r0, #1\r
 494     orr     r0, r0, #0x200000\r
 495     cmp     r0, r1\r
 496     bgt     m_read16_nosram\r
 497     ldr     r1, [r2, #4]    @ SRam.start\r
 498     cmp     r0, r1\r
 499     blt     m_read16_nosram\r
 500     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg\r
 501     tst     r1, #5\r
 502     beq     m_read16_nosram\r
 503     stmfd   sp!,{lr}\r
 504     bl      SRAMRead16\r
 505     ldmfd   sp!,{pc}\r
 506 m_read16_nosram:\r
 507     ldr     r1, [r3, #4]    @ romsize\r
 508     cmp     r0, r1\r
 509     movgt   r0, #0\r
 510     bxgt    lr              @ bad location\r
 511     ldr     r1, [r3]        @ 1ci\r
 512     ldrh    r0, [r1, r0]\r
 513     bx      lr\r
 514 \r
 515 m_read16_rom5: @ 0x280000 - 0x2fffff\r
 516     m_read16_rom 5\r
 517 \r
 518 m_read16_rom6: @ 0x300000 - 0x37ffff\r
 519     m_read16_rom 6\r
 520 \r
 521 m_read16_rom7: @ 0x380000 - 0x3fffff\r
 522     m_read16_rom 7\r
 523 \r
 524 m_read16_rom8: @ 0x400000 - 0x47ffff\r
 525     m_read16_rom 8\r
 526 \r
 527 m_read16_rom9: @ 0x480000 - 0x4fffff\r
 528     m_read16_rom 9\r
 529 \r
 530 m_read16_romA: @ 0x500000 - 0x57ffff\r
 531     m_read16_rom 0xA\r
 532 \r
 533 m_read16_romB: @ 0x580000 - 0x5fffff\r
 534     m_read16_rom 0xB\r
 535 \r
 536 m_read16_romC: @ 0x600000 - 0x67ffff\r
 537     m_read16_rom 0xC\r
 538 \r
 539 m_read16_romD: @ 0x680000 - 0x6fffff\r
 540     m_read16_rom 0xD\r
 541 \r
 542 m_read16_romE: @ 0x700000 - 0x77ffff\r
 543     m_read16_rom 0xE\r
 544 \r
 545 m_read16_romF: @ 0x780000 - 0x7fffff\r
 546     m_read16_rom 0xF\r
 547 \r
 548 m_read16_rom10: @ 0x800000 - 0x87ffff\r
 549     m_read16_rom 0x10\r
 550 \r
 551 m_read16_rom11: @ 0x880000 - 0x8fffff\r
 552     m_read16_rom 0x11\r
 553 \r
 554 m_read16_rom12: @ 0x900000 - 0x97ffff\r
 555     m_read16_rom 0x12\r
 556 \r
 557 m_read16_rom13: @ 0x980000 - 0x9fffff\r
 558     m_read16_rom 0x13\r
 559 \r
 560 m_read16_misc:\r
 561     bic     r0, r0, #1\r
 562     mov     r1, #16\r
 563     b       OtherRead16\r
 564 \r
 565 m_read16_vdp:\r
 566     tst     r0, #0x70000    @ if ((a&0xe700e0)==0xc00000)\r
 567     tsteq   r0, #0x000e0\r
 568     bxne    lr              @ invalid read\r
 569     bic     r0, r0, #1\r
 570     b       PicoVideoRead\r
 571 \r
 572 m_read16_ram:\r
 573     ldr     r1, =Pico\r
 574     bic     r0, r0, #0xff0000\r
 575     bic     r0, r0, #1\r
 576     ldrh    r0, [r1, r0]\r
 577     bx      lr\r
 578 \r
 579 m_read16_above_rom:\r
 580     @ might still be SRam\r
 581     ldr     r2, =(SRam)\r
 582     ldr     r3, =(Pico+0x22200)\r
 583     ldr     r1, [r2, #8]    @ SRam.end\r
 584     bic     r0, r0, #1\r
 585     cmp     r0, r1\r
 586     bgt     m_read16_ar_nosram\r
 587     ldr     r1, [r2, #4]    @ SRam.start\r
 588     cmp     r0, r1\r
 589     blt     m_read16_ar_nosram\r
 590     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg\r
 591     tst     r1, #5\r
 592     beq     m_read16_ar_nosram\r
 593     stmfd   sp!,{lr}\r
 594     bl      SRAMRead16\r
 595     ldmfd   sp!,{pc}\r
 596 m_read16_ar_nosram:\r
 597     ldr     r2, =PicoRead16Hook\r
 598     ldr     r2, [r2]\r
 599     mov     r1, #16\r
 600     bx      r2\r
 601 \r
 602 .pool\r
 603 \r
 604 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 605 \r
 606 .macro m_read32_rom sect\r
 607     ldr     r1, =(Pico+0x22200)\r
 608     bic     r0, r0, #0xf80000\r
 609     ldr     r1, [r1]\r
 610     bic     r0, r0, #1\r
 611 .if \sect\r
 612     orr     r0, r0, #0x080000*\sect\r
 613 .endif\r
 614     ldrh    r0, [r1, r0]!\r
 615     ldrh    r1, [r1, #2]           @ 1ci\r
 616     orr     r0, r1, r0, lsl #16\r
 617     bx      lr\r
 618 .endm\r
 619 \r
 620 \r
 621 m_read32_rom0: @ 0x000000 - 0x07ffff\r
 622     m_read32_rom 0\r
 623 \r
 624 m_read32_rom1: @ 0x080000 - 0x0fffff\r
 625     m_read32_rom 1\r
 626 \r
 627 m_read32_rom2: @ 0x100000 - 0x17ffff\r
 628     m_read32_rom 2\r
 629 \r
 630 m_read32_rom3: @ 0x180000 - 0x1fffff\r
 631     m_read32_rom 3\r
 632 \r
 633 m_read32_rom4: @ 0x200000 - 0x27ffff, SRAM area (does any game do long reads?)\r
 634     ldr     r2, =(SRam)\r
 635     ldr     r3, =(Pico+0x22200)\r
 636     ldr     r1, [r2, #8]    @ SRam.end\r
 637     bic     r0, r0, #0xf80000\r
 638     bic     r0, r0, #1\r
 639     orr     r0, r0, #0x200000\r
 640     cmp     r0, r1\r
 641     bgt     m_read32_nosram\r
 642     ldr     r1, [r2, #4]    @ SRam.start\r
 643     cmp     r0, r1\r
 644     blt     m_read32_nosram\r
 645     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg\r
 646     tst     r1, #5\r
 647     beq     m_read32_nosram\r
 648     stmfd   sp!,{r0,lr}\r
 649     bl      SRAMRead16\r
 650     ldmfd   sp!,{r1,lr}\r
 651     stmfd   sp!,{r0,lr}\r
 652     add     r0, r1, #2\r
 653     bl      SRAMRead16\r
 654     ldmfd   sp!,{r1,lr}\r
 655     orr     r0, r0, r1, lsl #16\r
 656     bx      lr\r
 657 m_read32_nosram:\r
 658     ldr     r1, [r3, #4]    @ romsize\r
 659     cmp     r0, r1\r
 660     movgt   r0, #0\r
 661     bxgt    lr              @ bad location\r
 662     ldr     r1, [r3]        @ (1ci)\r
 663     ldrh    r0, [r1, r0]!\r
 664     ldrh    r1, [r1, #2]    @ (2ci)\r
 665     orr     r0, r1, r0, lsl #16\r
 666     bx      lr\r
 667 \r
 668 m_read32_rom5: @ 0x280000 - 0x2fffff\r
 669     m_read32_rom 5\r
 670 \r
 671 m_read32_rom6: @ 0x300000 - 0x37ffff\r
 672     m_read32_rom 6\r
 673 \r
 674 m_read32_rom7: @ 0x380000 - 0x3fffff\r
 675     m_read32_rom 7\r
 676 \r
 677 m_read32_rom8: @ 0x400000 - 0x47ffff\r
 678     m_read32_rom 8\r
 679 \r
 680 m_read32_rom9: @ 0x480000 - 0x4fffff\r
 681     m_read32_rom 9\r
 682 \r
 683 m_read32_romA: @ 0x500000 - 0x57ffff\r
 684     m_read32_rom 0xA\r
 685 \r
 686 m_read32_romB: @ 0x580000 - 0x5fffff\r
 687     m_read32_rom 0xB\r
 688 \r
 689 m_read32_romC: @ 0x600000 - 0x67ffff\r
 690     m_read32_rom 0xC\r
 691 \r
 692 m_read32_romD: @ 0x680000 - 0x6fffff\r
 693     m_read32_rom 0xD\r
 694 \r
 695 m_read32_romE: @ 0x700000 - 0x77ffff\r
 696     m_read32_rom 0xE\r
 697 \r
 698 m_read32_romF: @ 0x780000 - 0x7fffff\r
 699     m_read32_rom 0xF\r
 700 \r
 701 m_read32_rom10: @ 0x800000 - 0x87ffff\r
 702     m_read32_rom 0x10\r
 703 \r
 704 m_read32_rom11: @ 0x880000 - 0x8fffff\r
 705     m_read32_rom 0x11\r
 706 \r
 707 m_read32_rom12: @ 0x900000 - 0x97ffff\r
 708     m_read32_rom 0x12\r
 709 \r
 710 m_read32_rom13: @ 0x980000 - 0x9fffff\r
 711     m_read32_rom 0x13\r
 712 \r
 713 m_read32_misc:\r
 714     bic     r0, r0, #1\r
 715     stmfd   sp!,{r0,lr}\r
 716     mov     r1, #32\r
 717     bl      OtherRead16\r
 718     mov     r1, r0\r
 719     ldmfd   sp!,{r0}\r
 720     stmfd   sp!,{r1}\r
 721     add     r0, r0, #2\r
 722     mov     r1, #32\r
 723     bl      OtherRead16\r
 724     ldmfd   sp!,{r1,lr}\r
 725     orr     r0, r0, r1, lsl #16\r
 726     bx      lr\r
 727 \r
 728 m_read32_vdp:\r
 729     tst     r0, #0x70000\r
 730     tsteq   r0, #0x000e0\r
 731     bxne    lr              @ invalid read\r
 732     bic     r0, r0, #1\r
 733     add     r1, r0, #2\r
 734     stmfd   sp!,{r1,lr}\r
 735     bl      PicoVideoRead\r
 736     swp     r0, r0, [sp]\r
 737     bl      PicoVideoRead\r
 738     ldmfd   sp!,{r1,lr}\r
 739     orr     r0, r0, r1, lsl #16\r
 740     bx      lr\r
 741 \r
 742 m_read32_ram:\r
 743     ldr     r1, =Pico\r
 744     bic     r0, r0, #0xff0000\r
 745     bic     r0, r0, #1\r
 746     ldrh    r0, [r1, r0]!\r
 747     ldrh    r1, [r1, #2]    @ 2ci\r
 748     orr     r0, r1, r0, lsl #16\r
 749     bx      lr\r
 750 \r
 751 m_read32_above_rom:\r
 752     ldr     r2, =PicoRead16Hook\r
 753     bic     r0, r0, #1\r
 754     ldr     r2, [r2]\r
 755     mov     r1, #32\r
 756     stmfd   sp!,{r0,r2,lr}\r
 757     mov     lr, pc\r
 758     bx      r2\r
 759     mov     r1, r0\r
 760     ldmfd   sp!,{r0,r2}\r
 761     stmfd   sp!,{r1}\r
 762     add     r0, r0, #2\r
 763     mov     r1, #32\r
 764     mov     lr, pc\r
 765     bx      r2\r
 766     ldmfd   sp!,{r1,lr}\r
 767     orr     r0, r0, r1, lsl #16\r
 768     bx      lr\r
 769 \r
 770 .pool\r
 771 \r
 772 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 773 \r
 774 PicoWriteRomHW_SSF2: @ u32 a, u32 d\r
 775     and     r0, r0, #0xe\r
 776     movs    r0, r0, lsr #1\r
 777     bne     pwr_banking\r
 778 \r
 779     @ sram register\r
 780     ldr     r2, =(Pico+0x22211) @ Pico.m.sram_reg\r
 781     ldrb    r0, [r2]\r
 782     and     r1, r1, #3\r
 783     bic     r0, r0, #3\r
 784     orr     r0, r0, r1\r
 785     strb    r0, [r2]\r
 786     bx      lr\r
 787 \r
 788 pwr_banking:\r
 789     and     r1, r1, #0x1f\r
 790 \r
 791     ldr     r3, =m_read8_def_table\r
 792     ldr     r2, =m_read8_table\r
 793     ldr     r12, [r3, r1, lsl #2]\r
 794     str     r12, [r2, r0, lsl #2]\r
 795 \r
 796     ldr     r3, =m_read16_def_table\r
 797     ldr     r2, =m_read16_table\r
 798     ldr     r12, [r3, r1, lsl #2]\r
 799     str     r12, [r2, r0, lsl #2]\r
 800 \r
 801     ldr     r3, =m_read32_def_table\r
 802     ldr     r2, =m_read32_table\r
 803     ldr     r12, [r3, r1, lsl #2]\r
 804     str     r12, [r2, r0, lsl #2]\r
 805  \r
 806     bx      lr\r
 807 \r
 808 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 809 \r
 810 @ Here we only handle most often used locations,\r
 811 @ everything else is passed to generic handlers\r
 812 \r
 813 PicoWrite8: @ u32 a, u8 d\r
 814     bic     r0, r0, #0xff000000\r
 815     and     r2, r0, #0x00e00000\r
 816     cmp     r2,     #0x00e00000 @ RAM?\r
 817     ldr     r3, =Pico\r
 818     biceq   r0, r0, #0x00ff0000\r
 819     eoreq   r0, r0, #1\r
 820     streqb  r1, [r3, r0]\r
 821     bxeq    lr\r
 822 \r
 823 m_m68k_write8_misc:\r
 824     bic     r2, r0, #0x1f    @ most commonly we get i/o port write,\r
 825     cmp     r2, #0xa10000    @ so check for it first\r
 826     bne     m_write8_misc2\r
 827 m_write8_io:\r
 828     ldr     r2, =PicoOpt\r
 829     and     r0, r0, #0x1e\r
 830     ldr     r2, [r2]\r
 831     ldr     r3, =(Pico+0x22000) @ Pico.ioports\r
 832     tst     r2, #0x20        @ 6 button pad?\r
 833     streqb  r1, [r3, r0, lsr #1]\r
 834     bxeq    lr\r
 835     cmp     r0, #2\r
 836     cmpne   r0, #4\r
 837     bne     m_write8_io_done @ not likely to happen\r
 838     add     r2, r3, #0x200   @ Pico+0x22200\r
 839     mov     r12,#0\r
 840     cmp     r0, #2\r
 841     streqb  r12,[r2,#0x18]\r
 842     strneb  r12,[r2,#0x19]   @ Pico.m.padDelay[i] = 0\r
 843     tst     r1, #0x40        @ TH\r
 844     beq     m_write8_io_done\r
 845     ldrb    r12,[r3, r0, lsr #1]\r
 846     tst     r12,#0x40\r
 847     bne     m_write8_io_done\r
 848     cmp     r0, #2\r
 849     ldreqb  r12,[r2,#0x0a]\r
 850     ldrneb  r12,[r2,#0x0b]   @ Pico.m.padTHPhase\r
 851     add     r12,r12,#1\r
 852     streqb  r12,[r2,#0x0a]\r
 853     strneb  r12,[r2,#0x0b]   @ Pico.m.padTHPhase\r
 854 m_write8_io_done:\r
 855     strb    r1, [r3, r0, lsr #1]\r
 856     bx      lr\r
 857 \r
 858 \r
 859 m_write8_misc2:\r
 860     and     r2, r0, #0xff0000\r
 861     cmp     r2,     #0xa00000 @ z80 area?\r
 862     bne     m_write8_not_z80\r
 863     tst     r0, #0x4000\r
 864     bne     m_write8_z80_not_ram\r
 865     ldr     r3, =(Pico+0x20000) @ Pico.zram\r
 866     add     r2, r3, #0x02200 @ Pico+0x22200\r
 867     ldrb    r2, [r2, #9]     @ Pico.m.z80Run\r
 868     bic     r0, r0, #0xff0000\r
 869     bic     r0, r0, #0x00e000\r
 870     tst     r2, #1\r
 871     streqb  r1, [r3, r0]     @ zram\r
 872     bx      lr\r
 873 \r
 874 m_write8_z80_not_ram:\r
 875     and     r2, r0, #0x6000\r
 876     cmp     r2,     #0x4000\r
 877     bne     m_write8_z80_not_ym2612\r
 878     ldr     r3, =PicoOpt\r
 879     and     r0, r0, #3\r
 880     ldr     r3, [r3]\r
 881     mov     r2, #0           @ is_from_z80 = 0\r
 882     tst     r3, #1\r
 883     bxeq    lr\r
 884     stmfd   sp!,{lr}\r
 885     and     r1, r1, #0xff\r
 886     bl      ym2612_write_local\r
 887     ldr     r2, =emustatus\r
 888     ldmfd   sp!,{lr}\r
 889     ldr     r1, [r2]\r
 890     and     r0, r0, #1\r
 891     orr     r1, r0, r1\r
 892     str     r1, [r2]         @ emustatus|=ym2612_write_local(a&3, d);\r
 893     bx      lr\r
 894 \r
 895 m_write8_z80_not_ym2612:     @ not too likely\r
 896     mov     r2, r0, lsl #17\r
 897     bic     r2, r2, #6<<17\r
 898     mov     r3,     #0x7f00\r
 899     orr     r3, r3, #0x0011\r
 900     cmp     r3, r2, lsr #17  @ psg @ z80 area?\r
 901     beq     m_write8_psg\r
 902     and     r2, r0, #0x7f00\r
 903     cmp     r2,     #0x6000  @ bank register?\r
 904     bxne    lr               @ invalid write\r
 905 \r
 906 m_write8_z80_bank_reg:\r
 907     ldr     r3, =(Pico+0x22208) @ Pico.m\r
 908     ldrh    r2, [r3, #0x0a]\r
 909     mov     r1, r1, lsl #8\r
 910     orr     r2, r1, r2, lsr #1\r
 911     bic     r2, r2, #0xfe00\r
 912     strh    r2, [r3, #0x0a]\r
 913     bx      lr\r
 914 \r
 915 \r
 916 m_write8_not_z80:\r
 917     and     r2, r0, #0xe70000\r
 918     cmp     r2, #0xc00000    @ VDP area?\r
 919     bne     OtherWrite8      @ passthrough\r
 920     and     r2, r0, #0xf9\r
 921     cmp     r2, #0x11\r
 922     bne     OtherWrite8\r
 923 m_write8_psg:\r
 924     ldr     r2, =PicoOpt\r
 925     and     r0, r1, #0xff\r
 926     ldr     r2, [r2]\r
 927     tst     r2, #2\r
 928     bxeq    lr\r
 929     b       SN76496Write\r
 930 \r