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