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 \r
  11 .text\r
  12 \r
  13 @ default jump tables\r
  14 \r
  15 m_read8_def_table:\r
  16     .long   m_read8_rom0    @ 0x000000 - 0x07FFFF\r
  17     .long   m_read8_rom1    @ 0x080000 - 0x0FFFFF\r
  18     .long   m_read8_rom2    @ 0x100000 - 0x17FFFF\r
  19     .long   m_read8_rom3    @ 0x180000 - 0x1FFFFF\r
  20     .long   m_read8_rom4    @ 0x200000 - 0x27FFFF\r
  21     .long   m_read8_rom5    @ 0x280000 - 0x2FFFFF\r
  22     .long   m_read8_rom6    @ 0x300000 - 0x37FFFF\r
  23     .long   m_read8_rom7    @ 0x380000 - 0x3FFFFF\r
  24     .long   m_read8_rom8    @ 0x400000 - 0x47FFFF\r
  25     .long   m_read8_rom9    @ 0x480000 - 0x4FFFFF\r
  26     .long   m_read8_romA    @ 0x500000 - 0x57FFFF\r
  27     .long   m_read8_romB    @ 0x580000 - 0x5FFFFF\r
  28     .long   m_read8_romC    @ 0x600000 - 0x67FFFF\r
  29     .long   m_read8_romD    @ 0x680000 - 0x6FFFFF\r
  30     .long   m_read8_romE    @ 0x700000 - 0x77FFFF\r
  31     .long   m_read8_romF    @ 0x780000 - 0x7FFFFF\r
  32     .long   m_read_null     @ 0x800000 - 0x87FFFF\r
  33     .long   m_read_null     @ 0x880000 - 0x8FFFFF\r
  34     .long   m_read_null     @ 0x900000 - 0x97FFFF\r
  35     .long   m_read_null     @ 0x980000 - 0x9FFFFF\r
  36     .long   m_read8_misc    @ 0xA00000 - 0xA7FFFF\r
  37     .long   m_read_null     @ 0xA80000 - 0xAFFFFF\r
  38     .long   m_read_null     @ 0xB00000 - 0xB7FFFF\r
  39     .long   m_read_null     @ 0xB80000 - 0xBFFFFF\r
  40     .long   m_read8_vdp     @ 0xC00000 - 0xC7FFFF\r
  41     .long   m_read8_vdp     @ 0xC80000 - 0xCFFFFF\r
  42     .long   m_read_null     @ 0xD00000 - 0xD7FFFF\r
  43     .long   m_read_null     @ 0xD80000 - 0xDFFFFF\r
  44     .long   m_read8_ram     @ 0xE00000 - 0xE7FFFF\r
  45     .long   m_read8_ram     @ 0xE80000 - 0xEFFFFF\r
  46     .long   m_read8_ram     @ 0xF00000 - 0xF7FFFF\r
  47     .long   m_read8_ram     @ 0xF80000 - 0xFFFFFF\r
  48 \r
  49 m_read16_def_table:\r
  50     .long   m_read16_rom0    @ 0x000000 - 0x07FFFF\r
  51     .long   m_read16_rom1    @ 0x080000 - 0x0FFFFF\r
  52     .long   m_read16_rom2    @ 0x100000 - 0x17FFFF\r
  53     .long   m_read16_rom3    @ 0x180000 - 0x1FFFFF\r
  54     .long   m_read16_rom4    @ 0x200000 - 0x27FFFF\r
  55     .long   m_read16_rom5    @ 0x280000 - 0x2FFFFF\r
  56     .long   m_read16_rom6    @ 0x300000 - 0x37FFFF\r
  57     .long   m_read16_rom7    @ 0x380000 - 0x3FFFFF\r
  58     .long   m_read16_rom8    @ 0x400000 - 0x47FFFF\r
  59     .long   m_read16_rom9    @ 0x480000 - 0x4FFFFF\r
  60     .long   m_read16_romA    @ 0x500000 - 0x57FFFF\r
  61     .long   m_read16_romB    @ 0x580000 - 0x5FFFFF\r
  62     .long   m_read16_romC    @ 0x600000 - 0x67FFFF\r
  63     .long   m_read16_romD    @ 0x680000 - 0x6FFFFF\r
  64     .long   m_read16_romE    @ 0x700000 - 0x77FFFF\r
  65     .long   m_read16_romF    @ 0x780000 - 0x7FFFFF\r
  66     .long   m_read_null      @ 0x800000 - 0x87FFFF\r
  67     .long   m_read_null      @ 0x880000 - 0x8FFFFF\r
  68     .long   m_read_null      @ 0x900000 - 0x97FFFF\r
  69     .long   m_read_null      @ 0x980000 - 0x9FFFFF\r
  70     .long   m_read16_misc    @ 0xA00000 - 0xA7FFFF\r
  71     .long   m_read_null      @ 0xA80000 - 0xAFFFFF\r
  72     .long   m_read_null      @ 0xB00000 - 0xB7FFFF\r
  73     .long   m_read_null      @ 0xB80000 - 0xBFFFFF\r
  74     .long   m_read16_vdp     @ 0xC00000 - 0xC7FFFF\r
  75     .long   m_read_null      @ 0xC80000 - 0xCFFFFF\r
  76     .long   m_read_null      @ 0xD00000 - 0xD7FFFF\r
  77     .long   m_read_null      @ 0xD80000 - 0xDFFFFF\r
  78     .long   m_read16_ram     @ 0xE00000 - 0xE7FFFF\r
  79     .long   m_read16_ram     @ 0xE80000 - 0xEFFFFF\r
  80     .long   m_read16_ram     @ 0xF00000 - 0xF7FFFF\r
  81     .long   m_read16_ram     @ 0xF80000 - 0xFFFFFF\r
  82 \r
  83 m_read32_def_table:\r
  84     .long   m_read32_rom0    @ 0x000000 - 0x07FFFF\r
  85     .long   m_read32_rom1    @ 0x080000 - 0x0FFFFF\r
  86     .long   m_read32_rom2    @ 0x100000 - 0x17FFFF\r
  87     .long   m_read32_rom3    @ 0x180000 - 0x1FFFFF\r
  88     .long   m_read32_rom4    @ 0x200000 - 0x27FFFF\r
  89     .long   m_read32_rom5    @ 0x280000 - 0x2FFFFF\r
  90     .long   m_read32_rom6    @ 0x300000 - 0x37FFFF\r
  91     .long   m_read32_rom7    @ 0x380000 - 0x3FFFFF\r
  92     .long   m_read32_rom8    @ 0x400000 - 0x47FFFF\r
  93     .long   m_read32_rom9    @ 0x480000 - 0x4FFFFF\r
  94     .long   m_read32_romA    @ 0x500000 - 0x57FFFF\r
  95     .long   m_read32_romB    @ 0x580000 - 0x5FFFFF\r
  96     .long   m_read32_romC    @ 0x600000 - 0x67FFFF\r
  97     .long   m_read32_romD    @ 0x680000 - 0x6FFFFF\r
  98     .long   m_read32_romE    @ 0x700000 - 0x77FFFF\r
  99     .long   m_read32_romF    @ 0x780000 - 0x7FFFFF\r
 100     .long   m_read_null      @ 0x800000 - 0x87FFFF\r
 101     .long   m_read_null      @ 0x880000 - 0x8FFFFF\r
 102     .long   m_read_null      @ 0x900000 - 0x97FFFF\r
 103     .long   m_read_null      @ 0x980000 - 0x9FFFFF\r
 104     .long   m_read32_misc    @ 0xA00000 - 0xA7FFFF\r
 105     .long   m_read_null      @ 0xA80000 - 0xAFFFFF\r
 106     .long   m_read_null      @ 0xB00000 - 0xB7FFFF\r
 107     .long   m_read_null      @ 0xB80000 - 0xBFFFFF\r
 108     .long   m_read32_vdp     @ 0xC00000 - 0xC7FFFF\r
 109     .long   m_read_null      @ 0xC80000 - 0xCFFFFF\r
 110     .long   m_read_null      @ 0xD00000 - 0xD7FFFF\r
 111     .long   m_read_null      @ 0xD80000 - 0xDFFFFF\r
 112     .long   m_read32_ram     @ 0xE00000 - 0xE7FFFF\r
 113     .long   m_read32_ram     @ 0xE80000 - 0xEFFFFF\r
 114     .long   m_read32_ram     @ 0xF00000 - 0xF7FFFF\r
 115     .long   m_read32_ram     @ 0xF80000 - 0xFFFFFF\r
 116 \r
 117 \r
 118 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 119 \r
 120 .bss\r
 121 @.section .bss, "brw"\r
 122 @.data\r
 123 \r
 124 @ used tables\r
 125 m_read8_table:\r
 126     .skip 32*4\r
 127 \r
 128 m_read16_table:\r
 129     .skip 32*4\r
 130 \r
 131 m_read32_table:\r
 132     .skip 32*4\r
 133 \r
 134 \r
 135 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 136 \r
 137 .text\r
 138 \r
 139 .global PicoMemReset\r
 140 .global PicoRead8\r
 141 .global PicoRead16\r
 142 .global PicoRead32\r
 143 .global PicoWriteRomHW_SSF2\r
 144 \r
 145 \r
 146 PicoMemReset:\r
 147     ldr     r12,=(Pico+0x22204)\r
 148     ldr     r12,[r12]                @ romsize\r
 149     add     r12,r12,#0x80000\r
 150     sub     r12,r12,#1\r
 151     mov     r12,r12,lsr #19\r
 152 \r
 153     ldr     r0, =m_read8_table\r
 154     ldr     r1, =m_read8_def_table\r
 155     mov     r2, #32\r
 156 1:\r
 157     ldr     r3, [r1], #4\r
 158     str     r3, [r0], #4\r
 159     subs    r2, r2, #1\r
 160     bne     1b\r
 161 \r
 162     ldr     r0, =m_read16_table\r
 163     ldr     r1, =m_read16_def_table\r
 164     mov     r2, #32\r
 165 1:\r
 166     subs    r2, r2, #1\r
 167     ldr     r3, [r1], #4\r
 168     str     r3, [r0], #4\r
 169     bne     1b\r
 170 \r
 171     ldr     r0, =m_read32_table\r
 172     ldr     r1, =m_read32_def_table\r
 173     mov     r2, #32\r
 174 1:\r
 175     subs    r2, r2, #1\r
 176     ldr     r3, [r1], #4\r
 177     str     r3, [r0], #4\r
 178     bne     1b\r
 179 \r
 180     @ update memhandlers according to ROM size\r
 181     ldr     r1, =m_read8_above_rom\r
 182     ldr     r0, =m_read8_table\r
 183     mov     r2, #16\r
 184 1:\r
 185     sub     r2, r2, #1\r
 186     cmp     r2, r12\r
 187     blt     2f\r
 188     cmp     r2, #4\r
 189     beq     1b                      @ do not touch the SRAM area\r
 190     str     r1, [r0, r2, lsl #2]\r
 191     b       1b\r
 192 2:\r
 193     ldr     r1, =m_read16_above_rom\r
 194     ldr     r0, =m_read16_table\r
 195     mov     r2, #16\r
 196 1:\r
 197     sub     r2, r2, #1\r
 198     cmp     r2, r12\r
 199     blt     2f\r
 200     cmp     r2, #4\r
 201     beq     1b\r
 202     str     r1, [r0, r2, lsl #2]\r
 203     b       1b\r
 204 2:\r
 205     ldr     r1, =m_read32_above_rom\r
 206     ldr     r0, =m_read32_table\r
 207     mov     r2, #16\r
 208 1:\r
 209     sub     r2, r2, #1\r
 210     cmp     r2, r12\r
 211     blt     2f\r
 212     cmp     r2, #4\r
 213     beq     1b\r
 214     str     r1, [r0, r2, lsl #2]\r
 215     b       1b\r
 216 2:\r
 217     bx      lr\r
 218 \r
 219 .pool\r
 220 \r
 221 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 222 \r
 223 PicoRead8: @ u32 a\r
 224     ldr     r2, =m_read8_table\r
 225     bic     r0, r0, #0xff000000\r
 226     and     r1, r0, #0x00f80000\r
 227     ldr     pc, [r2, r1, lsr #17]\r
 228 \r
 229 PicoRead16: @ u32 a\r
 230     ldr     r2, =m_read16_table\r
 231     bic     r0, r0, #0xff000000\r
 232     and     r1, r0, #0x00f80000\r
 233     ldr     pc, [r2, r1, lsr #17]\r
 234 \r
 235 PicoRead32: @ u32 a\r
 236     ldr     r2, =m_read32_table\r
 237     bic     r0, r0, #0xff000000\r
 238     and     r1, r0, #0x00f80000\r
 239     ldr     pc, [r2, r1, lsr #17]\r
 240 \r
 241 .pool\r
 242 \r
 243 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 244 \r
 245 m_read_null:\r
 246     mov     r0, #0\r
 247     bx      lr\r
 248 \r
 249 \r
 250 .macro m_read8_rom sect\r
 251     ldr     r1, =(Pico+0x22200)\r
 252     bic     r0, r0, #0xf80000\r
 253     ldr     r1, [r1]\r
 254 .if \sect\r
 255     orr     r0, r0, #0x080000*\sect\r
 256 .endif\r
 257     eor     r0, r0, #1\r
 258     ldrb    r0, [r1, r0]\r
 259     bx      lr\r
 260 .endm\r
 261 \r
 262 \r
 263 m_read8_rom0: @ 0x000000 - 0x07ffff\r
 264     m_read8_rom 0\r
 265 \r
 266 m_read8_rom1: @ 0x080000 - 0x0fffff\r
 267     m_read8_rom 1\r
 268 \r
 269 m_read8_rom2: @ 0x100000 - 0x17ffff\r
 270     m_read8_rom 2\r
 271 \r
 272 m_read8_rom3: @ 0x180000 - 0x1fffff\r
 273     m_read8_rom 3\r
 274 \r
 275 m_read8_rom4: @ 0x200000 - 0x27ffff, SRAM area\r
 276     ldr     r2, =(SRam)\r
 277     ldr     r3, =(Pico+0x22200)\r
 278     ldr     r1, [r2, #8]    @ SRam.end\r
 279     bic     r0, r0, #0xf80000\r
 280     orr     r0, r0, #0x200000\r
 281     cmp     r0, r1\r
 282     bgt     m_read8_nosram\r
 283     ldr     r1, [r2, #4]    @ SRam.start (1ci)\r
 284     cmp     r0, r1\r
 285     blt     m_read8_nosram\r
 286     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg (1ci)\r
 287     sub     r12,r0, #0x200000\r
 288     tst     r1, #0x10\r
 289     bne     m_read8_detected\r
 290     cmp     r12,#1\r
 291     ble     m_read8_detected\r
 292     tst     r1, #1\r
 293     orrne   r1, r1, #0x10\r
 294     strneb  r1, [r3, #0x11]\r
 295 m_read8_detected:\r
 296     tst     r1, #4          @ EEPROM read?\r
 297     ldrne   r0, =SRAMReadEEPROM @ (1ci if ne)\r
 298     bxne    r0\r
 299 m_read8_noteeprom:\r
 300     tst     r1, #1\r
 301     beq     m_read8_nosram\r
 302     ldr     r3, [r2]        @ SRam.data\r
 303     ldr     r2, [r2, #4]    @ SRam.start (1ci)\r
 304     sub     r3, r3, r2\r
 305     ldrb    r0, [r3, r0]\r
 306     bx      lr\r
 307 m_read8_nosram:\r
 308     ldr     r1, [r3, #4]    @ 1ci\r
 309     cmp     r0, r1\r
 310     movgt   r0, #0\r
 311     bxgt    lr              @ bad location\r
 312     ldr     r1, [r3]\r
 313     eor     r0, r0, #1\r
 314     ldrb    r0, [r1, r0]\r
 315     bx      lr\r
 316 \r
 317 m_read8_rom5: @ 0x280000 - 0x2fffff\r
 318     m_read8_rom 5\r
 319 \r
 320 m_read8_rom6: @ 0x300000 - 0x37ffff\r
 321     m_read8_rom 6\r
 322 \r
 323 m_read8_rom7: @ 0x380000 - 0x3fffff\r
 324     m_read8_rom 7\r
 325 \r
 326 m_read8_rom8: @ 0x400000 - 0x47ffff\r
 327     m_read8_rom 8\r
 328 \r
 329 m_read8_rom9: @ 0x480000 - 0x4fffff\r
 330     m_read8_rom 9\r
 331 \r
 332 @ is any ROM using that much?\r
 333 m_read8_romA: @ 0x500000 - 0x57ffff\r
 334     m_read8_rom 0xA\r
 335 \r
 336 m_read8_romB: @ 0x580000 - 0x5fffff\r
 337     m_read8_rom 0xB\r
 338 \r
 339 m_read8_romC: @ 0x600000 - 0x67ffff\r
 340     m_read8_rom 0xC\r
 341 \r
 342 m_read8_romD: @ 0x680000 - 0x6fffff\r
 343     m_read8_rom 0xD\r
 344 \r
 345 m_read8_romE: @ 0x700000 - 0x77ffff\r
 346     m_read8_rom 0xE\r
 347 \r
 348 m_read8_romF: @ 0x780000 - 0x7fffff\r
 349     m_read8_rom 0xF\r
 350 \r
 351 m_read8_misc:\r
 352     bic     r2, r0, #0x00ff\r
 353     bic     r2, r2, #0xbf00\r
 354     cmp     r2, #0xa00000  @ Z80 RAM?\r
 355     ldreq   r2, =z80Read8\r
 356     bxeq    r2\r
 357     stmfd   sp!,{r0,lr}\r
 358     bic     r0, r0, #1\r
 359     mov     r1, #8\r
 360     bl      OtherRead16\r
 361     ldmfd   sp!,{r1,lr}\r
 362     tst     r1, #1\r
 363     moveq   r0, r0, lsr #8\r
 364     bx      lr\r
 365 \r
 366 m_read8_vdp:\r
 367     tst     r0, #0x70000\r
 368     tsteq   r0, #0x000e0\r
 369     bxne    lr              @ invalid read\r
 370     stmfd   sp!,{r0,lr}\r
 371     bic     r0, r0, #1\r
 372     bl      PicoVideoRead\r
 373     ldmfd   sp!,{r1,lr}\r
 374     tst     r1, #1\r
 375     moveq   r0, r0, lsr #8\r
 376     bx      lr\r
 377 \r
 378 m_read8_ram:\r
 379     ldr     r1, =Pico\r
 380     bic     r0, r0, #0xff0000\r
 381     eor     r0, r0, #1\r
 382     ldrb    r0, [r1, r0]\r
 383     bx      lr\r
 384 \r
 385 m_read8_above_rom:\r
 386     stmfd   sp!,{r0,lr}\r
 387     bic     r0, r0, #1\r
 388     mov     r1, #8\r
 389     bl      OtherRead16End\r
 390     ldmfd   sp!,{r1,lr}\r
 391     tst     r1, #1\r
 392     moveq   r0, r0, lsr #8\r
 393     bx      lr\r
 394 \r
 395 .pool\r
 396 \r
 397 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 398 \r
 399 .macro m_read16_rom sect\r
 400     ldr     r1, =(Pico+0x22200)\r
 401     bic     r0, r0, #0xf80000\r
 402     ldr     r1, [r1]\r
 403     bic     r0, r0, #1\r
 404 .if \sect\r
 405     orr     r0, r0, #0x080000*\sect\r
 406 .endif\r
 407     ldrh    r0, [r1, r0]\r
 408     bx      lr\r
 409 .endm\r
 410 \r
 411 \r
 412 m_read16_rom0: @ 0x000000 - 0x07ffff\r
 413     m_read16_rom 0\r
 414 \r
 415 m_read16_rom1: @ 0x080000 - 0x0fffff\r
 416     m_read16_rom 1\r
 417 \r
 418 m_read16_rom2: @ 0x100000 - 0x17ffff\r
 419     m_read16_rom 2\r
 420 \r
 421 m_read16_rom3: @ 0x180000 - 0x1fffff\r
 422     m_read16_rom 3\r
 423 \r
 424 m_read16_rom4: @ 0x200000 - 0x27ffff, SRAM area (NBA Live 95)\r
 425     ldr     r2, =(SRam)\r
 426     ldr     r3, =(Pico+0x22200)\r
 427     ldr     r1, [r2, #8]    @ SRam.end\r
 428     bic     r0, r0, #0xf80000\r
 429     bic     r0, r0, #1\r
 430     orr     r0, r0, #0x200000\r
 431     cmp     r0, r1\r
 432     bgt     m_read16_nosram\r
 433     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg (2ci)\r
 434     tst     r1, #1\r
 435     beq     m_read16_nosram\r
 436     ldr     r1, [r2, #4]    @ SRam.start (1ci)\r
 437     cmp     r0, r1\r
 438     blt     m_read16_nosram\r
 439     ldr     r2, [r2]        @ SRam.data (1ci)\r
 440     sub     r2, r2, r1\r
 441     ldrh    r0, [r2, r0]    @ 2ci\r
 442     and     r1, r0, #0xff\r
 443     mov     r0, r0, lsr #8\r
 444     orr     r0, r0, r1, lsl #8\r
 445     bx      lr\r
 446 \r
 447 m_read16_nosram:\r
 448     ldr     r1, [r3, #4]    @ 1ci\r
 449     cmp     r0, r1\r
 450     movgt   r0, #0\r
 451     bxgt    lr              @ bad location\r
 452     ldr     r1, [r3]        @ 1ci\r
 453     ldrh    r0, [r1, r0]\r
 454     bx      lr\r
 455 \r
 456 m_read16_rom5: @ 0x280000 - 0x2fffff\r
 457     m_read16_rom 5\r
 458 \r
 459 m_read16_rom6: @ 0x300000 - 0x37ffff\r
 460     m_read16_rom 6\r
 461 \r
 462 m_read16_rom7: @ 0x380000 - 0x3fffff\r
 463     m_read16_rom 7\r
 464 \r
 465 m_read16_rom8: @ 0x400000 - 0x47ffff\r
 466     m_read16_rom 8\r
 467 \r
 468 m_read16_rom9: @ 0x480000 - 0x4fffff\r
 469     m_read16_rom 9\r
 470 \r
 471 @ is any ROM using that much?\r
 472 m_read16_romA: @ 0x500000 - 0x57ffff\r
 473     m_read16_rom 0xA\r
 474 \r
 475 m_read16_romB: @ 0x580000 - 0x5fffff\r
 476     m_read16_rom 0xB\r
 477 \r
 478 m_read16_romC: @ 0x600000 - 0x67ffff\r
 479     m_read16_rom 0xC\r
 480 \r
 481 m_read16_romD: @ 0x680000 - 0x6fffff\r
 482     m_read16_rom 0xD\r
 483 \r
 484 m_read16_romE: @ 0x700000 - 0x77ffff\r
 485     m_read16_rom 0xE\r
 486 \r
 487 m_read16_romF: @ 0x780000 - 0x7fffff\r
 488     m_read16_rom 0xF\r
 489 \r
 490 m_read16_misc:\r
 491     bic     r0, r0, #1\r
 492     mov     r1, #16\r
 493     b       OtherRead16\r
 494 \r
 495 m_read16_vdp:\r
 496     tst     r0, #0x70000\r
 497     tsteq   r0, #0x000e0\r
 498     bxne    lr              @ invalid read\r
 499     bic     r0, r0, #1\r
 500     b       PicoVideoRead\r
 501 \r
 502 m_read16_ram:\r
 503     ldr     r1, =Pico\r
 504     bic     r0, r0, #0xff0000\r
 505     bic     r0, r0, #1\r
 506     ldrh    r0, [r1, r0]\r
 507     bx      lr\r
 508 \r
 509 m_read16_above_rom:\r
 510     bic     r0, r0, #1\r
 511     mov     r1, #16\r
 512     b       OtherRead16End\r
 513 \r
 514 .pool\r
 515 \r
 516 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 517 \r
 518 .macro m_read32_rom sect\r
 519     ldr     r1, =(Pico+0x22200)\r
 520     bic     r0, r0, #0xf80000\r
 521     ldr     r1, [r1]\r
 522     bic     r0, r0, #1\r
 523 .if \sect\r
 524     orr     r0, r0, #0x080000*\sect\r
 525 .endif\r
 526     ldrh    r0, [r1, r0]!\r
 527     ldrh    r1, [r1, #2]           @ 1ci\r
 528     orr     r0, r1, r0, lsl #16\r
 529     bx      lr\r
 530 .endm\r
 531 \r
 532 \r
 533 m_read32_rom0: @ 0x000000 - 0x07ffff\r
 534     m_read32_rom 0\r
 535 \r
 536 m_read32_rom1: @ 0x080000 - 0x0fffff\r
 537     m_read32_rom 1\r
 538 \r
 539 m_read32_rom2: @ 0x100000 - 0x17ffff\r
 540     m_read32_rom 2\r
 541 \r
 542 m_read32_rom3: @ 0x180000 - 0x1fffff\r
 543     m_read32_rom 3\r
 544 \r
 545 m_read32_rom4: @ 0x200000 - 0x27ffff, SRAM area (does any game do long reads?)\r
 546     ldr     r2, =(SRam)\r
 547     ldr     r3, =(Pico+0x22200)\r
 548     ldr     r1, [r2, #8]    @ SRam.end\r
 549     bic     r0, r0, #0xf80000\r
 550     bic     r0, r0, #1\r
 551     orr     r0, r0, #0x200000\r
 552     cmp     r0, r1\r
 553     bgt     m_read32_nosram\r
 554     ldrb    r1, [r3, #0x11] @ Pico.m.sram_reg (2ci)\r
 555     tst     r1, #1\r
 556     beq     m_read32_nosram\r
 557     ldr     r1, [r2, #4]    @ SRam.start (1ci)\r
 558     cmp     r0, r1\r
 559     blt     m_read32_nosram\r
 560     ldr     r2, [r2]        @ SRam.data (1ci)\r
 561     sub     r2, r2, r1\r
 562     ldrh    r0, [r2, r0]!   @ (1ci)\r
 563     ldrh    r1, [r2, #2]\r
 564     orr     r0, r0, r0, lsl #16\r
 565     mov     r0, r0, ror #8\r
 566     mov     r0, r0, lsl #16\r
 567     orr     r0, r0, r1, lsr #8\r
 568     and     r1, r1, #0xff\r
 569     orr     r0, r0, r1, lsl #8\r
 570     bx      lr\r
 571 \r
 572 m_read32_nosram:\r
 573     ldr     r1, [r3, #4]    @ (1ci)\r
 574     cmp     r0, r1\r
 575     movgt   r0, #0\r
 576     bxgt    lr              @ bad location\r
 577     ldr     r1, [r3]        @ (1ci)\r
 578     ldrh    r0, [r1, r0]!\r
 579     ldrh    r1, [r1, #2]    @ (2ci)\r
 580     orr     r0, r1, r0, lsl #16\r
 581     bx      lr\r
 582 \r
 583 m_read32_rom5: @ 0x280000 - 0x2fffff\r
 584     m_read32_rom 5\r
 585 \r
 586 m_read32_rom6: @ 0x300000 - 0x37ffff\r
 587     m_read32_rom 6\r
 588 \r
 589 m_read32_rom7: @ 0x380000 - 0x3fffff\r
 590     m_read32_rom 7\r
 591 \r
 592 m_read32_rom8: @ 0x400000 - 0x47ffff\r
 593     m_read32_rom 8\r
 594 \r
 595 m_read32_rom9: @ 0x480000 - 0x4fffff\r
 596     m_read32_rom 9\r
 597 \r
 598 @ is any ROM using that much?\r
 599 m_read32_romA: @ 0x500000 - 0x57ffff\r
 600     m_read32_rom 0xA\r
 601 \r
 602 m_read32_romB: @ 0x580000 - 0x5fffff\r
 603     m_read32_rom 0xB\r
 604 \r
 605 m_read32_romC: @ 0x600000 - 0x67ffff\r
 606     m_read32_rom 0xC\r
 607 \r
 608 m_read32_romD: @ 0x680000 - 0x6fffff\r
 609     m_read32_rom 0xD\r
 610 \r
 611 m_read32_romE: @ 0x700000 - 0x77ffff\r
 612     m_read32_rom 0xE\r
 613 \r
 614 m_read32_romF: @ 0x780000 - 0x7fffff\r
 615     m_read32_rom 0xF\r
 616 \r
 617 m_read32_misc:\r
 618     bic     r0, r0, #1\r
 619     stmfd   sp!,{r0,lr}\r
 620     mov     r1, #32\r
 621     bl      OtherRead16\r
 622     mov     r1, r0\r
 623     ldmfd   sp!,{r0}\r
 624     stmfd   sp!,{r1}\r
 625     add     r0, r0, #2\r
 626     mov     r1, #32\r
 627     bl      OtherRead16\r
 628     ldmfd   sp!,{r1,lr}\r
 629     orr     r0, r0, r1, lsl #16\r
 630     bx      lr\r
 631 \r
 632 m_read32_vdp:\r
 633     tst     r0, #0x70000\r
 634     tsteq   r0, #0x000e0\r
 635     bxne    lr              @ invalid read\r
 636     bic     r0, r0, #1\r
 637     add     r1, r0, #2\r
 638     stmfd   sp!,{r1,lr}\r
 639     bl      PicoVideoRead\r
 640     swp     r0, r0, [sp]\r
 641     bl      PicoVideoRead\r
 642     ldmfd   sp!,{r1,lr}\r
 643     orr     r0, r0, r1, lsl #16\r
 644     bx      lr\r
 645 \r
 646 m_read32_ram:\r
 647     ldr     r1, =Pico\r
 648     bic     r0, r0, #0xff0000\r
 649     bic     r0, r0, #1\r
 650     ldrh    r0, [r1, r0]!\r
 651     ldrh    r1, [r1, #2]    @ 2ci\r
 652     orr     r0, r1, r0, lsl #16\r
 653     bx      lr\r
 654 \r
 655 m_read32_above_rom:\r
 656     bic     r0, r0, #1\r
 657     stmfd   sp!,{r0,lr}\r
 658     mov     r1, #32\r
 659     bl      OtherRead16End\r
 660     mov     r1, r0\r
 661     ldmfd   sp!,{r0}\r
 662     stmfd   sp!,{r1}\r
 663     add     r0, r0, #2\r
 664     mov     r1, #32\r
 665     bl      OtherRead16End\r
 666     ldmfd   sp!,{r1,lr}\r
 667     orr     r0, r0, r1, lsl #16\r
 668     bx      lr\r
 669 \r
 670 .pool\r
 671 \r
 672 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
 673 \r
 674 PicoWriteRomHW_SSF2: @ u32 a, u32 d\r
 675     and     r0, r0, #0xe\r
 676     movs    r0, r0, lsr #1\r
 677     bne     pwr_banking\r
 678 \r
 679     @ sram register\r
 680     ldr     r2, =(Pico+0x22211) @ Pico.m.sram_reg\r
 681     ldrb    r0, [r2]\r
 682     and     r1, r1, #3\r
 683     bic     r0, r0, #3\r
 684     orr     r0, r0, r1\r
 685     strb    r0, [r2]\r
 686     bx      lr\r
 687 \r
 688 pwr_banking:\r
 689     and     r1, r1, #0x1f\r
 690 \r
 691     ldr     r3, =m_read8_def_table\r
 692     ldr     r2, =m_read8_table\r
 693     ldr     r12, [r3, r1, lsl #2]\r
 694     str     r12, [r2, r0, lsl #2]\r
 695 \r
 696     ldr     r3, =m_read16_def_table\r
 697     ldr     r2, =m_read16_table\r
 698     ldr     r12, [r3, r1, lsl #2]\r
 699     str     r12, [r2, r0, lsl #2]\r
 700 \r
 701     ldr     r3, =m_read32_def_table\r
 702     ldr     r2, =m_read32_table\r
 703     ldr     r12, [r3, r1, lsl #2]\r
 704     str     r12, [r2, r0, lsl #2]\r
 705  \r
 706     bx      lr\r
 707 \r