[picodrive.git] / pico / cd / memory_arm.s

@ vim:filetype=armasm

@ Memory I/O handlers for Sega/Mega CD emulation
@ (c) Copyright 2007-2009, Grazvydas "notaz" Ignotas


.equiv PCM_STEP_SHIFT, 11

.text
.align 2

.global PicoReadM68k8_io
.global PicoReadM68k16_io
.global PicoWriteM68k8_io
.global PicoWriteM68k16_io

.global PicoReadS68k8_pr
.global PicoReadS68k16_pr
.global PicoWriteS68k8_pr
.global PicoWriteS68k16_pr

.global PicoReadM68k8_cell0
.global PicoReadM68k8_cell1
.global PicoReadM68k16_cell0
.global PicoReadM68k16_cell1
.global PicoWriteM68k8_cell0
.global PicoWriteM68k8_cell1
.global PicoWriteM68k16_cell0
.global PicoWriteM68k16_cell1

.global PicoReadS68k8_dec0
.global PicoReadS68k8_dec1
.global PicoReadS68k16_dec0
.global PicoReadS68k16_dec1
.global PicoWriteS68k8_dec_m0b0
.global PicoWriteS68k8_dec_m1b0
.global PicoWriteS68k8_dec_m2b0
.global PicoWriteS68k8_dec_m0b1
.global PicoWriteS68k8_dec_m1b1
.global PicoWriteS68k8_dec_m2b1
.global PicoWriteS68k16_dec_m0b0
.global PicoWriteS68k16_dec_m1b0
.global PicoWriteS68k16_dec_m2b0
.global PicoWriteS68k16_dec_m0b1
.global PicoWriteS68k16_dec_m1b1
.global PicoWriteS68k16_dec_m2b1

@ externs, just for reference
.extern Pico
.extern Read_CDC_Host
.extern m68k_reg_write8
.extern s68k_reg_read16
.extern s68k_reg_write8
.extern s68k_poll_adclk
.extern s68k_poll_detect
.extern gfx_cd_read
.extern gfx_cd_write16
.extern PicoCpuCS68k
.extern PicoRead8_io
.extern PicoRead16_io
.extern PicoWrite8_io
.extern PicoWrite16_io


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@

@ utilities

@ r0=addr[in,out], r1,r2=tmp
.macro cell_map
    ands    r1, r0, #0x01c000
    ldrne   pc, [pc, r1, lsr #12]
    beq     0f                          @ most common?
    .long   0f
    .long   0f
    .long   0f
    .long   0f
    .long   1f
    .long   1f
    .long   2f
    .long   3f
1: @ x16 cells
    and     r1, r0, #0x7e00             @ col
    and     r2, r0, #0x01fc             @ row
    orr     r2, r2, #0x0400
    orr     r1, r2, r1, ror #13
    b       9f
2: @ x8 cells
    and     r1, r0, #0x3f00             @ col
    and     r2, r0, #0x00fc             @ row
    orr     r2, r2, #0x0600
    orr     r1, r2, r1, ror #12
    b       9f
3: @ x4 cells
    and     r1, r0, #0x1f80             @ col
    and     r2, r0, #0x007c             @ row
    orr     r1, r2, r1, ror #11
    and     r2, r0,#0x1e000
    orr     r1, r1, r2, lsr #6
    b       9f
0: @ x32 cells
    and     r1, r0, #0xfc00             @ col
    and     r2, r0, #0x03fc             @ row
    orr     r1, r2, r1, ror #14
9:
    and     r0, r0, #3
    orr     r0, r0, r1, ror #26         @ rol 4+2
.endm


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


m_read_null:
    mov     r0, #0
    bx      lr


PicoReadM68k8_cell0:                    @ 0x220000 - 0x23ffff, cell arranged
    mov     r3, #0x0c0000
    b       0f

PicoReadM68k8_cell1:                    @ 0x220000 - 0x23ffff, cell arranged
    mov     r3, #0x0e0000
0:
    cell_map
    ldr     r1, =(Pico+0x22200)
    add     r0, r0, r3
    ldr     r1, [r1]
    eor     r0, r0, #1
    ldrb    r0, [r1, r0]
    bx      lr


PicoReadM68k8_io:
    and     r1, r0, #0xff00
    cmp     r1, #0x2000	              @ a120xx?
    bne     PicoRead8_io

    ldr     r1, =(Pico+0x22200)
    and     r0, r0, #0x3f
    ldr     r1, [r1]                  @ Pico.mcd (used everywhere)
    cmp     r0, #0x0e
    ldrlt   pc, [pc, r0, lsl #2]
    b       m_m68k_read8_hi
    .long   m_m68k_read8_r00
    .long   m_m68k_read8_r01
    .long   m_m68k_read8_r02
    .long   m_m68k_read8_r03
    .long   m_m68k_read8_r04
    .long   m_read_null               @ unused bits
    .long   m_m68k_read8_r06
    .long   m_m68k_read8_r07
    .long   m_m68k_read8_r08
    .long   m_m68k_read8_r09
    .long   m_read_null               @ reserved
    .long   m_read_null
    .long   m_m68k_read8_r0c
    .long   m_m68k_read8_r0d
m_m68k_read8_r00:
    add     r1, r1, #0x110000
    ldr     r0, [r1, #0x30]
    and     r0, r0, #0x04000000       @ we need irq2 mask state
    mov     r0, r0, lsr #19
    bx      lr
m_m68k_read8_r01:
    add     r1, r1, #0x110000
    add     r1, r1, #0x002200
    ldrb    r0, [r1, #2]              @ Pico_mcd->m.busreq
    bx      lr
m_m68k_read8_r02:
    add     r1, r1, #0x110000
    ldrb    r0, [r1, #2]
    bx      lr
m_m68k_read8_r03:
    add     r1, r1, #0x110000
    ldrb    r0, [r1, #3]
    add     r1, r1, #0x002200
    ldr     r1, [r1, #4]
    and     r0, r0, #0xc7
    tst     r1, #2                    @ DMNA pending?
    bxeq    lr
    bic     r0, r0, #1
    orr     r0, r0, #2
    bx      lr
m_m68k_read8_r04:
    add     r1, r1, #0x110000
    ldrb    r0, [r1, #4]
    bx      lr
m_m68k_read8_r06:
    ldrb    r0, [r1, #0x73]           @ IRQ vector
    bx      lr
m_m68k_read8_r07:
    ldrb    r0, [r1, #0x72]
    bx      lr
m_m68k_read8_r08:
    mov     r0, #0
    bl      Read_CDC_Host             @ TODO: make it local
    mov     r0, r0, lsr #8
    bx      lr
m_m68k_read8_r09:
    mov     r0, #0
    b       Read_CDC_Host
m_m68k_read8_r0c:
    add     r1, r1, #0x110000
    add     r1, r1, #0x002200
    ldr     r0, [r1, #0x14]           @ Pico_mcd->m.timer_stopwatch
    mov     r0, r0, lsr #24
    bx      lr
m_m68k_read8_r0d:
    add     r1, r1, #0x110000
    add     r1, r1, #0x002200
    ldr     r0, [r1, #0x14]
    mov     r0, r0, lsr #16
    bx      lr
m_m68k_read8_hi:
    cmp     r0, #0x30
    movge   r0, #0
    bxeq    lr
    add     r1, r1, #0x110000
    ldrb    r0, [r1, r0]
    bx      lr


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


PicoReadM68k16_cell0:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r3, #0x0c0000
    b       0f

PicoReadM68k16_cell1:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r3, #0x0e0000
0:
    cell_map
    ldr     r1, =(Pico+0x22200)
    add     r0, r0, r3
    ldr     r1, [r1]
    bic     r0, r0, #1
    ldrh    r0, [r1, r0]
    bx      lr


PicoReadM68k16_io:
    and     r1, r0, #0xff00
    cmp     r1, #0x2000	              @ a120xx
    bne     PicoRead16_io

m_m68k_read16_m68k_regs:
    ldr     r1, =(Pico+0x22200)
    and     r0, r0, #0x3e
    ldr     r1, [r1]                  @ Pico.mcd (used everywhere)
    cmp     r0, #0x0e
    ldrlt   pc, [pc, r0, lsl #1]
    b       m_m68k_read16_hi
    .long   m_m68k_read16_r00
    .long   m_m68k_read16_r02
    .long   m_m68k_read16_r04
    .long   m_m68k_read16_r06
    .long   m_m68k_read16_r08
    .long   m_read_null               @ reserved
    .long   m_m68k_read16_r0c
m_m68k_read16_r00:
    add     r1, r1, #0x110000
    ldr     r0, [r1, #0x30]
    add     r1, r1, #0x002200
    ldrb    r1, [r1, #2]              @ Pico_mcd->m.busreq
    and     r0, r0, #0x04000000       @ we need irq2 mask state
    orr     r0, r1, r0, lsr #11
    bx      lr
m_m68k_read16_r02:
    add     r1, r1, #0x110000
    ldrb    r0, [r1, #2]
    ldrb    r2, [r1, #3]
    add     r1, r1, #0x002200
    ldr     r1, [r1, #4]
    and     r2, r2, #0xc7
    orr     r0, r2, r0, lsl #8
    tst     r1, #2                    @ DMNA pending?
    bxeq    lr
    bic     r0, r0, #1
    orr     r0, r0, #2
    bx      lr
m_m68k_read16_r04:
    add     r1, r1, #0x110000
    ldrb    r0, [r1, #4]
    mov     r0, r0, lsl #8
    bx      lr
m_m68k_read16_r06:
    ldrh    r0, [r1, #0x72]           @ IRQ vector
    bx      lr
m_m68k_read16_r08:
    mov     r0, #0
    b       Read_CDC_Host
m_m68k_read16_r0c:
    add     r1, r1, #0x110000
    add     r1, r1, #0x002200
    ldr     r0, [r1, #0x14]
    mov     r0, r0, lsr #16
    bx      lr
m_m68k_read16_hi:
    cmp     r0, #0x30
    addlt   r1, r1, #0x110000
    ldrlth  r1, [r1, r0]
    movge   r0, #0
    bxge    lr
    mov     r0, r1, lsr #8
    and     r1, r1, #0xff
    orr     r0, r0, r1, lsl #8
    bx      lr


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


PicoWriteM68k8_cell0:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r12,#0x0c0000
    b       0f

PicoWriteM68k8_cell1:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r12,#0x0e0000
0:
    mov     r3, r1
    cell_map
    ldr     r2, =(Pico+0x22200)
    add     r0, r0, r12
    ldr     r2, [r2]
    eor     r0, r0, #1
    strb    r3, [r2, r0]
    bx      lr


PicoWriteM68k8_io:
    and     r2, r0, #0xff00
    cmp     r2, #0x2000                 @ a120xx?
    beq     m68k_reg_write8
    b       PicoWrite8_io


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


PicoWriteM68k16_cell0:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r12, #0x0c0000
    b       0f

PicoWriteM68k16_cell1:                   @ 0x220000 - 0x23ffff, cell arranged
    mov     r12, #0x0e0000
0:
    mov     r3, r1
    cell_map
    ldr     r1, =(Pico+0x22200)
    add     r0, r0, r12
    ldr     r1, [r1]
    bic     r0, r0, #1
    strh    r3, [r1, r0]
    bx      lr


PicoWriteM68k16_io:
    and     r2, r0, #0xff00
    cmp     r2, #0x2000                 @ a120xx?
    bne     PicoWrite16_io

m_m68k_write16_regs:
    and     r0, r0, #0x3e
    cmp     r0, #0x0e
    beq     m_m68k_write16_regs_spec
    and     r3, r1, #0xff
    add     r2, r0, #1
    stmfd   sp!,{r2,r3,lr}
    mov     r1, r1, lsr #8
    bl      m68k_reg_write8
    ldmfd   sp!,{r0,r1,lr}
    b       m68k_reg_write8

m_m68k_write16_regs_spec:               @ special case
    ldr     r2, =(Pico+0x22200)
    ldr     r3, =s68k_poll_adclk
    mov     r0, #0x110000
    ldr     r2, [r2]
    add     r0, r0, #0x00000e
    mov     r1, r1, lsr #8
    strb    r1, [r2, r0]                @ if (a == 0xe) s68k_regs[0x0e] = d >> 8;
    ldr     r2, [r3]
    mov     r1, #0
    and     r2, r2, #0xfe
    cmp     r2, #0x0e
    bxne    lr
    ldr     r0, =PicoCpuCS68k
    str     r1, [r0, #0x58]             @ push s68k out of stopped state
    str     r1, [r3]
    bx      lr


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
@                                   Sub 68k
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


PicoReadS68k8_dec0:                     @ 0x080000 - 0x0bffff
    mov     r3, #0x080000               @ + ^ / 2
    b       0f

PicoReadS68k8_dec1:
    mov     r3, #0x0a0000               @ + ^ / 2
0:
    ldr     r2, =(Pico+0x22200)
    eor     r0, r0, #2
    ldr     r2, [r2]
    movs    r0, r0, lsr #1              @ +4-6 <<16
    add     r2, r2, r3                  @ map to our address
    ldrb    r0, [r2, r0]
    movcc   r0, r0, lsr #4
    andcs   r0, r0, #0xf
    bx      lr


PicoReadS68k8_pr:
    and     r2, r0, #0xfe00
    cmp     r2, #0x8000
    bne     m_s68k_read8_pcm

m_s68k_read8_regs:
    bic     r0, r0, #0xff0000
    bic     r0, r0, #0x008000
    sub     r2, r0, #0x0e
    cmp     r2, #(0x30-0x0e)
    blo     m_s68k_read8_comm
    sub     r2, r0, #0x58
    cmp     r2, #0x10
    ldrlo   r2, =gfx_cd_read
    ldrhs   r2, =s68k_reg_read16
    stmfd   sp!,{r0,lr}
    bic     r0, r0, #1
    mov     lr, pc
    bx      r2
    ldmfd   sp!,{r1,lr}
    tst     r1, #1
    moveq   r0, r0, lsr #8
    and     r0, r0, #0xff
    bx      lr

m_s68k_read8_comm:
    ldr     r1, =(Pico+0x22200)
    ldr     r1, [r1]
    add     r1, r1, #0x110000
    ldrb    r1, [r1, r0]
    b       s68k_poll_detect


m_s68k_read8_pcm:
    tst     r0, #0x8000
    bne     m_read_null

    @ must not trash r3 and r12
    ldr     r1, =(Pico+0x22200)
    bic     r0, r0, #0xff0000
@    bic     r0, r0, #0x008000
    ldr     r1, [r1]
    mov     r2, #0x110000
    orr     r2, r2, #0x002200
    cmp     r0, #0x2000
    bge     m_s68k_read8_pcm_ram
    cmp     r0, #0x20
    movlt   r0, #0
    bxlt    lr
    orr     r2, r2, #(0x48+8)           @ pcm.ch + addr_offset
    add     r1, r1, r2
    and     r2, r0, #0x1c
    ldr     r1, [r1, r2, lsl #2]
    tst     r0, #2
    moveq   r0, r1, lsr #PCM_STEP_SHIFT
    movne   r0, r1, lsr #(PCM_STEP_SHIFT+8)
    and     r0, r0, #0xff
    bx      lr

m_s68k_read8_pcm_ram:
    orr     r2, r2, #0x40
    ldr     r2, [r1, r2]
    add     r1, r1, #0x100000           @ pcm_ram
    and     r2, r2, #0x0f000000         @ bank
    add     r1, r1, r2, lsr #12
    bic     r0, r0, #0x00e000
    mov     r0, r0, lsr #1
    ldrb    r0, [r1, r0]
    bx      lr


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


PicoReadS68k16_dec0:                    @ 0x080000 - 0x0bffff
    mov     r3, #0x080000               @ + ^ / 2
    b       0f

PicoReadS68k16_dec1:
    mov     r3, #0x0a0000               @ + ^ / 2
0:
    ldr     r2, =(Pico+0x22200)
    eor     r0, r0, #2
    ldr     r2, [r2]
    mov     r0, r0, lsr #1              @ +4-6 <<16
    add     r2, r2, r3                  @ map to our address
    ldrb    r0, [r2, r0]
    orr     r0, r0, r0, lsl #4
    bic     r0, r0, #0xf0
    bx      lr


PicoReadS68k16_pr:
    and     r2, r0, #0xfe00
    cmp     r2, #0x8000
    @ pcm is on 8-bit bus, would this be same as byte access?
    bne     m_s68k_read8_pcm

m_s68k_read16_regs:
    bic     r0, r0, #0xff0000
    bic     r0, r0, #0x008000
    bic     r0, r0, #0x000001
    sub     r2, r0, #0x58
    cmp     r2, #0x10
    blo     gfx_cd_read
    cmp     r0, #8
    bne     s68k_reg_read16
    mov     r0, #1
    b       Read_CDC_Host


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


.macro m_s68k_write8_2M_decode
    ldr     r2, =(Pico+0x22200)
    eor     r0, r0, #2
    ldr     r2, [r2]			@ Pico.rom
    movs    r0, r0, lsr #1              @ +4-6 <<16
    add     r2, r2, r3                  @ map to our address
.endm

PicoWriteS68k8_dec_m2b0:                @ overwrite
    ands    r1, r1, #0x0f
    bxeq    lr

PicoWriteS68k8_dec_m0b0:
    mov     r3, #0x080000
    b       0f

PicoWriteS68k8_dec_m2b1:                @ overwrite
    ands    r1, r1, #0x0f
    bxeq    lr

PicoWriteS68k8_dec_m0b1:
    mov     r3, #0x0a0000
0:
    m_s68k_write8_2M_decode
    ldrb    r0, [r2, r0]!
    and     r1, r1, #0x0f
    movcc   r1, r1, lsl #4
    andcc   r3, r0, #0x0f
    andcs   r3, r0, #0xf0
    orr     r3, r3, r1
    strneb  r3, [r2]
    bx      lr

PicoWriteS68k8_dec_m1b0:                @ underwrite
    mov     r3, #0x080000
    b       0f

PicoWriteS68k8_dec_m1b1:
    mov     r3, #0x0a0000
0:
    ands    r1, r1, #0x0f
    bxeq    lr
    m_s68k_write8_2M_decode
    ldrb    r0, [r2, r0]!
    movcc   r1, r1, lsl #4
    andcc   r3, r0, #0x0f
    andcs   r3, r0, #0xf0
    teq     r3, r0
    bxne    lr
    orr     r3, r3, r1
    strneb  r3, [r2]
    bx      lr


PicoWriteS68k8_pr:
    and     r2, r0, #0xfe00
    cmp     r2, #0x8000
    bne     m_s68k_write8_pcm

m_s68k_write8_regs:
    bic     r0, r0, #0xff0000
    bic     r0, r0, #0x008000
    tst     r0, #0x7e00
    movne   r0, #0
    bxne    lr
    sub     r2, r0, #0x58
    cmp     r2, #0x10
    bhs     s68k_reg_write8
    bic     r0, r0, #1
    orr     r1, r1, r1, lsl #8
    b       gfx_cd_write16


m_s68k_write8_pcm:
    tst     r0, #0x8000
    bxne    lr
    bic     r0, r0, #0xff0000
    cmp     r0, #0x12
    movlt   r0, r0, lsr #1
    blt     pcm_write

    cmp     r0, #0x2000
    bxlt    lr

m_s68k_write8_pcm_ram:
    ldr     r3, =(Pico+0x22200)
    bic     r0, r0, #0x00e000
    ldr     r3, [r3]
    mov     r0, r0, lsr #1
    add     r2, r3, #0x110000
    add     r2, r2, #0x002200
    add     r2, r2, #0x000040
    ldr     r2, [r2]
    add     r3, r3, #0x100000           @ pcm_ram
    and     r2, r2, #0x0f000000         @ bank
    add     r3, r3, r2, lsr #12
    strb    r1, [r3, r0]
    bx      lr


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@


.macro m_s68k_write16_2M_decode
    ldr     r2, =(Pico+0x22200)
    eor     r0, r0, #2
    ldr     r2, [r2]
    mov     r0, r0, lsr #1              @ +4-6 <<16
    add     r2, r2, r3                  @ map to our address
.endm

PicoWriteS68k16_dec_m0b0:
    mov     r3, #0x080000
    b       0f

PicoWriteS68k16_dec_m0b1:
    mov     r3, #0x0a0000
0:
    m_s68k_write16_2M_decode
    bic     r1, r1, #0xf0
    orr     r1, r1, r1, lsr #4
    strb    r1, [r2, r0]
    bx      lr

PicoWriteS68k16_dec_m1b0:               @ underwrite
    mov     r3, #0x080000
    b       0f

PicoWriteS68k16_dec_m1b1:
    mov     r3, #0x0a0000
0:
    bics    r1, r1, #0xf000
    bicnes  r1, r1, #0x00f0
    bxeq    lr
    orr     r1, r1, r1, lsr #4
    m_s68k_write16_2M_decode
    ldrb    r0, [r2, r0]!
    and     r3, r1, #0x0f
    and     r1, r1, #0xf0
    tst     r0, #0x0f
    orreq   r0, r0, r3
    tst     r0, #0xf0
    orreq   r0, r0, r1
    strb    r0, [r2]
    bx      lr

PicoWriteS68k16_dec_m2b0:               @ overwrite
    mov     r3, #0x080000
    b       0f

PicoWriteS68k16_dec_m2b1:
    mov     r3, #0x0a0000
0:
    bics    r1, r1, #0xf000
    bicnes  r1, r1, #0x00f0
    bxeq    lr
    orr     r1, r1, r1, lsr #4
    m_s68k_write16_2M_decode
    ldrb    r0, [r2, r0]!
    ands    r3, r1, #0x0f
    andne   r0, r0, #0xf0
    orrne   r0, r0, r3
    ands    r1, r1, #0xf0
    andne   r0, r0, #0x0f
    orrne   r0, r0, r1
    strb    r0, [r2]
    bx      lr


PicoWriteS68k16_pr:
    and     r2, r0, #0xfe00
    cmp     r2, #0x8000
    bne     m_s68k_write8_pcm

m_s68k_write16_regs:
    bic     r0, r0, #0xff0000
    bic     r0, r0, #0x008000
    bic     r0, r0, #1
    tst     r0, #0x7e00
    movne   r0, #0
    bxne    lr
    cmp     r0, #0x0e
    beq     m_s68k_write16_regs_spec
    sub     r2, r0, #0x58
    cmp     r2, #0x10
    blo     gfx_cd_write16
    and     r3, r1, #0xff
    add     r2, r0, #1
    stmfd   sp!,{r2,r3,lr}
    mov     r1, r1, lsr #8
    bl      s68k_reg_write8
    ldmfd   sp!,{r0,r1,lr}
    b       s68k_reg_write8

m_s68k_write16_regs_spec:               @ special case
    ldr     r2, =(Pico+0x22200)
    mov     r0, #0x110000
    ldr     r2, [r2]
    add     r0, r0, #0x00000f
    strb    r1, [r2, r0]                @ if (a == 0xe) s68k_regs[0xf] = d;
    bx      lr

.pool
Commit	Line	Data
4ff2d527	1	@ vim:filetype=armasm
4ff2d527	2
6cadc2da	3	@ Memory I/O handlers for Sega/Mega CD emulation
0ace9b9a	4	@ (c) Copyright 2007-2009, Grazvydas "notaz" Ignotas
4ff2d527	5
	6
	7	.equiv PCM_STEP_SHIFT, 11
4ff2d527	8
4ff2d527	9	.text
0ace9b9a	10	.align 2
	11
	12	.global PicoReadM68k8_io
	13	.global PicoReadM68k16_io
	14	.global PicoWriteM68k8_io
	15	.global PicoWriteM68k16_io
	16
	17	.global PicoReadS68k8_pr
	18	.global PicoReadS68k16_pr
	19	.global PicoWriteS68k8_pr
	20	.global PicoWriteS68k16_pr
	21
	22	.global PicoReadM68k8_cell0
	23	.global PicoReadM68k8_cell1
	24	.global PicoReadM68k16_cell0
	25	.global PicoReadM68k16_cell1
	26	.global PicoWriteM68k8_cell0
	27	.global PicoWriteM68k8_cell1
	28	.global PicoWriteM68k16_cell0
	29	.global PicoWriteM68k16_cell1
	30
	31	.global PicoReadS68k8_dec0
	32	.global PicoReadS68k8_dec1
	33	.global PicoReadS68k16_dec0
	34	.global PicoReadS68k16_dec1
	35	.global PicoWriteS68k8_dec_m0b0
	36	.global PicoWriteS68k8_dec_m1b0
	37	.global PicoWriteS68k8_dec_m2b0
	38	.global PicoWriteS68k8_dec_m0b1
	39	.global PicoWriteS68k8_dec_m1b1
	40	.global PicoWriteS68k8_dec_m2b1
	41	.global PicoWriteS68k16_dec_m0b0
	42	.global PicoWriteS68k16_dec_m1b0
	43	.global PicoWriteS68k16_dec_m2b0
	44	.global PicoWriteS68k16_dec_m0b1
	45	.global PicoWriteS68k16_dec_m1b1
	46	.global PicoWriteS68k16_dec_m2b1
4ff2d527	47
	48	@ externs, just for reference
	49	.extern Pico
4ff2d527	50	.extern Read_CDC_Host
4ff2d527	51	.extern m68k_reg_write8
4ff2d527	52	.extern s68k_reg_read16
4ff2d527	53	.extern s68k_reg_write8
7a1f6e45	54	.extern s68k_poll_adclk
2433f409	55	.extern s68k_poll_detect
0ace9b9a	56	.extern gfx_cd_read
	57	.extern gfx_cd_write16
	58	.extern PicoCpuCS68k
	59	.extern PicoRead8_io
	60	.extern PicoRead16_io
	61	.extern PicoWrite8_io
	62	.extern PicoWrite16_io
4ff2d527	63
4ff2d527	64
	65	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	66
	67	@ utilities
	68
	69	@ r0=addr[in,out], r1,r2=tmp
	70	.macro cell_map
	71	ands r1, r0, #0x01c000
	72	ldrne pc, [pc, r1, lsr #12]
	73	beq 0f @ most common?
	74	.long 0f
	75	.long 0f
	76	.long 0f
	77	.long 0f
	78	.long 1f
	79	.long 1f
	80	.long 2f
	81	.long 3f
	82	1: @ x16 cells
	83	and r1, r0, #0x7e00 @ col
	84	and r2, r0, #0x01fc @ row
	85	orr r2, r2, #0x0400
	86	orr r1, r2, r1, ror #13
	87	b 9f
	88	2: @ x8 cells
	89	and r1, r0, #0x3f00 @ col
	90	and r2, r0, #0x00fc @ row
	91	orr r2, r2, #0x0600
	92	orr r1, r2, r1, ror #12
	93	b 9f
	94	3: @ x4 cells
	95	and r1, r0, #0x1f80 @ col
	96	and r2, r0, #0x007c @ row
	97	orr r1, r2, r1, ror #11
	98	and r2, r0,#0x1e000
	99	orr r1, r1, r2, lsr #6
	100	b 9f
	101	0: @ x32 cells
	102	and r1, r0, #0xfc00 @ col
	103	and r2, r0, #0x03fc @ row
	104	orr r1, r2, r1, ror #14
	105	9:
	106	and r0, r0, #3
	107	orr r0, r0, r1, ror #26 @ rol 4+2
	108	.endm
	109
	110
4ff2d527	111	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	112
	113
	114	m_read_null:
	115	mov r0, #0
	116	bx lr
	117
	118
0ace9b9a	119	PicoReadM68k8_cell0: @ 0x220000 - 0x23ffff, cell arranged
	120	mov r3, #0x0c0000
	121	b 0f
4ff2d527	122
0ace9b9a	123	PicoReadM68k8_cell1: @ 0x220000 - 0x23ffff, cell arranged
	124	mov r3, #0x0e0000
	125	0:
4ff2d527	126	cell_map
4ff2d527	127	ldr r1, =(Pico+0x22200)
0ace9b9a	128	add r0, r0, r3
4ff2d527	129	ldr r1, [r1]
	130	eor r0, r0, #1
	131	ldrb r0, [r1, r0]
	132	bx lr
	133
	134
0ace9b9a	135	PicoReadM68k8_io:
	136	and r1, r0, #0xff00
	137	cmp r1, #0x2000 @ a120xx?
	138	bne PicoRead8_io
4ff2d527	139
	140	ldr r1, =(Pico+0x22200)
	141	and r0, r0, #0x3f
	142	ldr r1, [r1] @ Pico.mcd (used everywhere)
	143	cmp r0, #0x0e
	144	ldrlt pc, [pc, r0, lsl #2]
	145	b m_m68k_read8_hi
	146	.long m_m68k_read8_r00
	147	.long m_m68k_read8_r01
	148	.long m_m68k_read8_r02
	149	.long m_m68k_read8_r03
	150	.long m_m68k_read8_r04
	151	.long m_read_null @ unused bits
	152	.long m_m68k_read8_r06
	153	.long m_m68k_read8_r07
	154	.long m_m68k_read8_r08
	155	.long m_m68k_read8_r09
	156	.long m_read_null @ reserved
	157	.long m_read_null
	158	.long m_m68k_read8_r0c
	159	.long m_m68k_read8_r0d
	160	m_m68k_read8_r00:
	161	add r1, r1, #0x110000
00bd648e	162	ldr r0, [r1, #0x30]
4ff2d527	163	and r0, r0, #0x04000000 @ we need irq2 mask state
	164	mov r0, r0, lsr #19
	165	bx lr
	166	m_m68k_read8_r01:
	167	add r1, r1, #0x110000
	168	add r1, r1, #0x002200
	169	ldrb r0, [r1, #2] @ Pico_mcd->m.busreq
	170	bx lr
	171	m_m68k_read8_r02:
	172	add r1, r1, #0x110000
	173	ldrb r0, [r1, #2]
	174	bx lr
	175	m_m68k_read8_r03:
	176	add r1, r1, #0x110000
	177	ldrb r0, [r1, #3]
c008977e	178	add r1, r1, #0x002200
c008977e	179	ldr r1, [r1, #4]
4ff2d527	180	and r0, r0, #0xc7
c008977e	181	tst r1, #2 @ DMNA pending?
	182	bxeq lr
	183	bic r0, r0, #1
	184	orr r0, r0, #2
4ff2d527	185	bx lr
	186	m_m68k_read8_r04:
	187	add r1, r1, #0x110000
	188	ldrb r0, [r1, #4]
	189	bx lr
	190	m_m68k_read8_r06:
	191	ldrb r0, [r1, #0x73] @ IRQ vector
	192	bx lr
	193	m_m68k_read8_r07:
	194	ldrb r0, [r1, #0x72]
	195	bx lr
	196	m_m68k_read8_r08:
	197	mov r0, #0
	198	bl Read_CDC_Host @ TODO: make it local
	199	mov r0, r0, lsr #8
	200	bx lr
	201	m_m68k_read8_r09:
	202	mov r0, #0
	203	b Read_CDC_Host
	204	m_m68k_read8_r0c:
	205	add r1, r1, #0x110000
	206	add r1, r1, #0x002200
	207	ldr r0, [r1, #0x14] @ Pico_mcd->m.timer_stopwatch
	208	mov r0, r0, lsr #24
	209	bx lr
	210	m_m68k_read8_r0d:
	211	add r1, r1, #0x110000
	212	add r1, r1, #0x002200
	213	ldr r0, [r1, #0x14]
	214	mov r0, r0, lsr #16
	215	bx lr
	216	m_m68k_read8_hi:
	217	cmp r0, #0x30
	218	movge r0, #0
	219	bxeq lr
	220	add r1, r1, #0x110000
	221	ldrb r0, [r1, r0]
	222	bx lr
	223
4ff2d527	224
	225	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	226
	227
0ace9b9a	228	PicoReadM68k16_cell0: @ 0x220000 - 0x23ffff, cell arranged
	229	mov r3, #0x0c0000
	230	b 0f
4ff2d527	231
0ace9b9a	232	PicoReadM68k16_cell1: @ 0x220000 - 0x23ffff, cell arranged
	233	mov r3, #0x0e0000
	234	0:
4ff2d527	235	cell_map
4ff2d527	236	ldr r1, =(Pico+0x22200)
0ace9b9a	237	add r0, r0, r3
4ff2d527	238	ldr r1, [r1]
	239	bic r0, r0, #1
	240	ldrh r0, [r1, r0]
	241	bx lr
	242
	243
0ace9b9a	244	PicoReadM68k16_io:
	245	and r1, r0, #0xff00
	246	cmp r1, #0x2000 @ a120xx
	247	bne PicoRead16_io
4ff2d527	248
	249	m_m68k_read16_m68k_regs:
	250	ldr r1, =(Pico+0x22200)
	251	and r0, r0, #0x3e
	252	ldr r1, [r1] @ Pico.mcd (used everywhere)
	253	cmp r0, #0x0e
	254	ldrlt pc, [pc, r0, lsl #1]
	255	b m_m68k_read16_hi
	256	.long m_m68k_read16_r00
	257	.long m_m68k_read16_r02
	258	.long m_m68k_read16_r04
	259	.long m_m68k_read16_r06
	260	.long m_m68k_read16_r08
	261	.long m_read_null @ reserved
	262	.long m_m68k_read16_r0c
	263	m_m68k_read16_r00:
	264	add r1, r1, #0x110000
7a1f6e45	265	ldr r0, [r1, #0x30]
4ff2d527	266	add r1, r1, #0x002200
	267	ldrb r1, [r1, #2] @ Pico_mcd->m.busreq
	268	and r0, r0, #0x04000000 @ we need irq2 mask state
	269	orr r0, r1, r0, lsr #11
	270	bx lr
	271	m_m68k_read16_r02:
	272	add r1, r1, #0x110000
	273	ldrb r0, [r1, #2]
c008977e	274	ldrb r2, [r1, #3]
	275	add r1, r1, #0x002200
	276	ldr r1, [r1, #4]
	277	and r2, r2, #0xc7
	278	orr r0, r2, r0, lsl #8
	279	tst r1, #2 @ DMNA pending?
	280	bxeq lr
	281	bic r0, r0, #1
	282	orr r0, r0, #2
4ff2d527	283	bx lr
	284	m_m68k_read16_r04:
	285	add r1, r1, #0x110000
	286	ldrb r0, [r1, #4]
	287	mov r0, r0, lsl #8
	288	bx lr
	289	m_m68k_read16_r06:
	290	ldrh r0, [r1, #0x72] @ IRQ vector
	291	bx lr
	292	m_m68k_read16_r08:
	293	mov r0, #0
	294	b Read_CDC_Host
	295	m_m68k_read16_r0c:
	296	add r1, r1, #0x110000
	297	add r1, r1, #0x002200
	298	ldr r0, [r1, #0x14]
	299	mov r0, r0, lsr #16
	300	bx lr
	301	m_m68k_read16_hi:
	302	cmp r0, #0x30
	303	addlt r1, r1, #0x110000
	304	ldrlth r1, [r1, r0]
	305	movge r0, #0
	306	bxge lr
	307	mov r0, r1, lsr #8
	308	and r1, r1, #0xff
	309	orr r0, r0, r1, lsl #8
	310	bx lr
	311
	312
0ace9b9a	313	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
4ff2d527	314
4ff2d527	315
0ace9b9a	316	PicoWriteM68k8_cell0: @ 0x220000 - 0x23ffff, cell arranged
	317	mov r12,#0x0c0000
	318	b 0f
4ff2d527	319
0ace9b9a	320	PicoWriteM68k8_cell1: @ 0x220000 - 0x23ffff, cell arranged
	321	mov r12,#0x0e0000
	322	0:
	323	mov r3, r1
	324	cell_map
	325	ldr r2, =(Pico+0x22200)
	326	add r0, r0, r12
	327	ldr r2, [r2]
	328	eor r0, r0, #1
	329	strb r3, [r2, r0]
4ff2d527	330	bx lr
	331
	332
0ace9b9a	333	PicoWriteM68k8_io:
	334	and r2, r0, #0xff00
	335	cmp r2, #0x2000 @ a120xx?
	336	beq m68k_reg_write8
	337	b PicoWrite8_io
	338
	339
4ff2d527	340	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	341
	342
0ace9b9a	343	PicoWriteM68k16_cell0: @ 0x220000 - 0x23ffff, cell arranged
	344	mov r12, #0x0c0000
	345	b 0f
	346
	347	PicoWriteM68k16_cell1: @ 0x220000 - 0x23ffff, cell arranged
	348	mov r12, #0x0e0000
	349	0:
	350	mov r3, r1
	351	cell_map
4ff2d527	352	ldr r1, =(Pico+0x22200)
0ace9b9a	353	add r0, r0, r12
4ff2d527	354	ldr r1, [r1]
4ff2d527	355	bic r0, r0, #1
0ace9b9a	356	strh r3, [r1, r0]
4ff2d527	357	bx lr
	358
	359
0ace9b9a	360	PicoWriteM68k16_io:
	361	and r2, r0, #0xff00
	362	cmp r2, #0x2000 @ a120xx?
	363	bne PicoWrite16_io
4ff2d527	364
0ace9b9a	365	m_m68k_write16_regs:
	366	and r0, r0, #0x3e
	367	cmp r0, #0x0e
	368	beq m_m68k_write16_regs_spec
	369	and r3, r1, #0xff
	370	add r2, r0, #1
	371	stmfd sp!,{r2,r3,lr}
	372	mov r1, r1, lsr #8
	373	bl m68k_reg_write8
	374	ldmfd sp!,{r0,r1,lr}
	375	b m68k_reg_write8
4ff2d527	376
0ace9b9a	377	m_m68k_write16_regs_spec: @ special case
	378	ldr r2, =(Pico+0x22200)
	379	ldr r3, =s68k_poll_adclk
	380	mov r0, #0x110000
	381	ldr r2, [r2]
	382	add r0, r0, #0x00000e
	383	mov r1, r1, lsr #8
	384	strb r1, [r2, r0] @ if (a == 0xe) s68k_regs[0x0e] = d >> 8;
	385	ldr r2, [r3]
	386	mov r1, #0
	387	and r2, r2, #0xfe
	388	cmp r2, #0x0e
	389	bxne lr
	390	ldr r0, =PicoCpuCS68k
	391	str r1, [r0, #0x58] @ push s68k out of stopped state
	392	str r1, [r3]
4ff2d527	393	bx lr
	394
	395
0ace9b9a	396	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	397	@ Sub 68k
	398	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
4ff2d527	399
4ff2d527	400
0ace9b9a	401	PicoReadS68k8_dec0: @ 0x080000 - 0x0bffff
	402	mov r3, #0x080000 @ + ^ / 2
	403	b 0f
4ff2d527	404
0ace9b9a	405	PicoReadS68k8_dec1:
	406	mov r3, #0x0a0000 @ + ^ / 2
	407	0:
5c69a605	408	ldr r2, =(Pico+0x22200)
	409	eor r0, r0, #2
	410	ldr r2, [r2]
	411	movs r0, r0, lsr #1 @ +4-6 <<16
0ace9b9a	412	add r2, r2, r3 @ map to our address
5c69a605	413	ldrb r0, [r2, r0]
	414	movcc r0, r0, lsr #4
	415	andcs r0, r0, #0xf
	416	bx lr
5c69a605	417
4ff2d527	418
0ace9b9a	419	PicoReadS68k8_pr:
	420	and r2, r0, #0xfe00
	421	cmp r2, #0x8000
	422	bne m_s68k_read8_pcm
4ff2d527	423
	424	m_s68k_read8_regs:
	425	bic r0, r0, #0xff0000
	426	bic r0, r0, #0x008000
2433f409	427	sub r2, r0, #0x0e
	428	cmp r2, #(0x30-0x0e)
	429	blo m_s68k_read8_comm
4ff2d527	430	sub r2, r0, #0x58
	431	cmp r2, #0x10
	432	ldrlo r2, =gfx_cd_read
	433	ldrhs r2, =s68k_reg_read16
	434	stmfd sp!,{r0,lr}
	435	bic r0, r0, #1
	436	mov lr, pc
	437	bx r2
	438	ldmfd sp!,{r1,lr}
	439	tst r1, #1
	440	moveq r0, r0, lsr #8
	441	and r0, r0, #0xff
	442	bx lr
	443
2433f409	444	m_s68k_read8_comm:
	445	ldr r1, =(Pico+0x22200)
	446	ldr r1, [r1]
	447	add r1, r1, #0x110000
	448	ldrb r1, [r1, r0]
	449	b s68k_poll_detect
	450
4ff2d527	451
0ace9b9a	452	m_s68k_read8_pcm:
	453	tst r0, #0x8000
	454	bne m_read_null
4ff2d527	455
0ace9b9a	456	@ must not trash r3 and r12
4ff2d527	457	ldr r1, =(Pico+0x22200)
0ace9b9a	458	bic r0, r0, #0xff0000
0ace9b9a	459	@ bic r0, r0, #0x008000
4ff2d527	460	ldr r1, [r1]
0ace9b9a	461	mov r2, #0x110000
	462	orr r2, r2, #0x002200
	463	cmp r0, #0x2000
	464	bge m_s68k_read8_pcm_ram
	465	cmp r0, #0x20
	466	movlt r0, #0
	467	bxlt lr
	468	orr r2, r2, #(0x48+8) @ pcm.ch + addr_offset
	469	add r1, r1, r2
	470	and r2, r0, #0x1c
	471	ldr r1, [r1, r2, lsl #2]
	472	tst r0, #2
	473	moveq r0, r1, lsr #PCM_STEP_SHIFT
	474	movne r0, r1, lsr #(PCM_STEP_SHIFT+8)
	475	and r0, r0, #0xff
5c69a605	476	bx lr
4ff2d527	477
0ace9b9a	478	m_s68k_read8_pcm_ram:
	479	orr r2, r2, #0x40
	480	ldr r2, [r1, r2]
	481	add r1, r1, #0x100000 @ pcm_ram
	482	and r2, r2, #0x0f000000 @ bank
	483	add r1, r1, r2, lsr #12
	484	bic r0, r0, #0x00e000
	485	mov r0, r0, lsr #1
	486	ldrb r0, [r1, r0]
	487	bx lr
4ff2d527	488
	489
	490	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	491
	492
0ace9b9a	493	PicoReadS68k16_dec0: @ 0x080000 - 0x0bffff
	494	mov r3, #0x080000 @ + ^ / 2
	495	b 0f
5c69a605	496
0ace9b9a	497	PicoReadS68k16_dec1:
	498	mov r3, #0x0a0000 @ + ^ / 2
	499	0:
5c69a605	500	ldr r2, =(Pico+0x22200)
	501	eor r0, r0, #2
	502	ldr r2, [r2]
	503	mov r0, r0, lsr #1 @ +4-6 <<16
0ace9b9a	504	add r2, r2, r3 @ map to our address
0ace9b9a	505	ldrb r0, [r2, r0]
5c69a605	506	orr r0, r0, r0, lsl #4
5c69a605	507	bic r0, r0, #0xf0
5c69a605	508	bx lr
4ff2d527	509
4ff2d527	510
0ace9b9a	511	PicoReadS68k16_pr:
	512	and r2, r0, #0xfe00
	513	cmp r2, #0x8000
	514	@ pcm is on 8-bit bus, would this be same as byte access?
	515	bne m_s68k_read8_pcm
4ff2d527	516
0ace9b9a	517	m_s68k_read16_regs:
4ff2d527	518	bic r0, r0, #0xff0000
	519	bic r0, r0, #0x008000
	520	bic r0, r0, #0x000001
4ff2d527	521	sub r2, r0, #0x58
4ff2d527	522	cmp r2, #0x10
0ace9b9a	523	blo gfx_cd_read
	524	cmp r0, #8
	525	bne s68k_reg_read16
	526	mov r0, #1
	527	b Read_CDC_Host
4ff2d527	528
4ff2d527	529
	530	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	531
	532
0ace9b9a	533	.macro m_s68k_write8_2M_decode
48e8482f	534	ldr r2, =(Pico+0x22200)
48e8482f	535	eor r0, r0, #2
0ace9b9a	536	ldr r2, [r2] @ Pico.rom
48e8482f	537	movs r0, r0, lsr #1 @ +4-6 <<16
0ace9b9a	538	add r2, r2, r3 @ map to our address
48e8482f	539	.endm
48e8482f	540
0ace9b9a	541	PicoWriteS68k8_dec_m2b0: @ overwrite
	542	ands r1, r1, #0x0f
	543	bxeq lr
	544
	545	PicoWriteS68k8_dec_m0b0:
	546	mov r3, #0x080000
	547	b 0f
	548
	549	PicoWriteS68k8_dec_m2b1: @ overwrite
	550	ands r1, r1, #0x0f
	551	bxeq lr
	552
	553	PicoWriteS68k8_dec_m0b1:
	554	mov r3, #0x0a0000
	555	0:
	556	m_s68k_write8_2M_decode
48e8482f	557	ldrb r0, [r2, r0]!
	558	and r1, r1, #0x0f
	559	movcc r1, r1, lsl #4
	560	andcc r3, r0, #0x0f
	561	andcs r3, r0, #0xf0
	562	orr r3, r3, r1
48e8482f	563	strneb r3, [r2]
48e8482f	564	bx lr
48e8482f	565
0ace9b9a	566	PicoWriteS68k8_dec_m1b0: @ underwrite
	567	mov r3, #0x080000
	568	b 0f
	569
	570	PicoWriteS68k8_dec_m1b1:
	571	mov r3, #0x0a0000
	572	0:
48e8482f	573	ands r1, r1, #0x0f
48e8482f	574	bxeq lr
0ace9b9a	575	m_s68k_write8_2M_decode
48e8482f	576	ldrb r0, [r2, r0]!
	577	movcc r1, r1, lsl #4
	578	andcc r3, r0, #0x0f
	579	andcs r3, r0, #0xf0
0ace9b9a	580	teq r3, r0
0ace9b9a	581	bxne lr
48e8482f	582	orr r3, r3, r1
48e8482f	583	strneb r3, [r2]
48e8482f	584	bx lr
48e8482f	585
48e8482f	586
0ace9b9a	587	PicoWriteS68k8_pr:
	588	and r2, r0, #0xfe00
	589	cmp r2, #0x8000
	590	bne m_s68k_write8_pcm
48e8482f	591
0ace9b9a	592	m_s68k_write8_regs:
4ff2d527	593	bic r0, r0, #0xff0000
0ace9b9a	594	bic r0, r0, #0x008000
	595	tst r0, #0x7e00
	596	movne r0, #0
	597	bxne lr
	598	sub r2, r0, #0x58
	599	cmp r2, #0x10
	600	bhs s68k_reg_write8
	601	bic r0, r0, #1
	602	orr r1, r1, r1, lsl #8
	603	b gfx_cd_write16
4ff2d527	604
	605
	606	m_s68k_write8_pcm:
0ace9b9a	607	tst r0, #0x8000
0ace9b9a	608	bxne lr
4ff2d527	609	bic r0, r0, #0xff0000
	610	cmp r0, #0x12
	611	movlt r0, r0, lsr #1
	612	blt pcm_write
	613
	614	cmp r0, #0x2000
	615	bxlt lr
	616
	617	m_s68k_write8_pcm_ram:
	618	ldr r3, =(Pico+0x22200)
	619	bic r0, r0, #0x00e000
	620	ldr r3, [r3]
	621	mov r0, r0, lsr #1
	622	add r2, r3, #0x110000
	623	add r2, r2, #0x002200
	624	add r2, r2, #0x000040
	625	ldr r2, [r2]
	626	add r3, r3, #0x100000 @ pcm_ram
	627	and r2, r2, #0x0f000000 @ bank
	628	add r3, r3, r2, lsr #12
	629	strb r1, [r3, r0]
	630	bx lr
	631
	632
4ff2d527	633	@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
	634
	635
0ace9b9a	636	.macro m_s68k_write16_2M_decode
48e8482f	637	ldr r2, =(Pico+0x22200)
	638	eor r0, r0, #2
	639	ldr r2, [r2]
	640	mov r0, r0, lsr #1 @ +4-6 <<16
0ace9b9a	641	add r2, r2, r3 @ map to our address
48e8482f	642	.endm
48e8482f	643
0ace9b9a	644	PicoWriteS68k16_dec_m0b0:
	645	mov r3, #0x080000
	646	b 0f
	647
	648	PicoWriteS68k16_dec_m0b1:
	649	mov r3, #0x0a0000
	650	0:
	651	m_s68k_write16_2M_decode
48e8482f	652	bic r1, r1, #0xf0
	653	orr r1, r1, r1, lsr #4
	654	strb r1, [r2, r0]
	655	bx lr
48e8482f	656
0ace9b9a	657	PicoWriteS68k16_dec_m1b0: @ underwrite
	658	mov r3, #0x080000
	659	b 0f
	660
	661	PicoWriteS68k16_dec_m1b1:
	662	mov r3, #0x0a0000
	663	0:
48e8482f	664	bics r1, r1, #0xf000
	665	bicnes r1, r1, #0x00f0
	666	bxeq lr
	667	orr r1, r1, r1, lsr #4
0ace9b9a	668	m_s68k_write16_2M_decode
48e8482f	669	ldrb r0, [r2, r0]!
	670	and r3, r1, #0x0f
	671	and r1, r1, #0xf0
	672	tst r0, #0x0f
	673	orreq r0, r0, r3
	674	tst r0, #0xf0
	675	orreq r0, r0, r1
	676	strb r0, [r2]
	677	bx lr
48e8482f	678
0ace9b9a	679	PicoWriteS68k16_dec_m2b0: @ overwrite
	680	mov r3, #0x080000
	681	b 0f
	682
	683	PicoWriteS68k16_dec_m2b1:
	684	mov r3, #0x0a0000
	685	0:
48e8482f	686	bics r1, r1, #0xf000
	687	bicnes r1, r1, #0x00f0
	688	bxeq lr
	689	orr r1, r1, r1, lsr #4
0ace9b9a	690	m_s68k_write16_2M_decode
48e8482f	691	ldrb r0, [r2, r0]!
	692	ands r3, r1, #0x0f
	693	andne r0, r0, #0xf0
	694	orrne r0, r0, r3
	695	ands r1, r1, #0xf0
	696	andne r0, r0, #0x0f
	697	orrne r0, r0, r1
	698	strb r0, [r2]
	699	bx lr
48e8482f	700
4ff2d527	701
0ace9b9a	702	PicoWriteS68k16_pr:
	703	and r2, r0, #0xfe00
	704	cmp r2, #0x8000
	705	bne m_s68k_write8_pcm
4ff2d527	706
	707	m_s68k_write16_regs:
	708	bic r0, r0, #0xff0000
	709	bic r0, r0, #0x008000
5c69a605	710	bic r0, r0, #1
4ff2d527	711	tst r0, #0x7e00
	712	movne r0, #0
	713	bxne lr
5c69a605	714	cmp r0, #0x0e
5c69a605	715	beq m_s68k_write16_regs_spec
4ff2d527	716	sub r2, r0, #0x58
4ff2d527	717	cmp r2, #0x10
5c69a605	718	blo gfx_cd_write16
4ff2d527	719	and r3, r1, #0xff
4ff2d527	720	add r2, r0, #1
4ff2d527	721	stmfd sp!,{r2,r3,lr}
	722	mov r1, r1, lsr #8
	723	bl s68k_reg_write8
	724	ldmfd sp!,{r0,r1,lr}
	725	b s68k_reg_write8
	726
5c69a605	727	m_s68k_write16_regs_spec: @ special case
	728	ldr r2, =(Pico+0x22200)
	729	mov r0, #0x110000
	730	ldr r2, [r2]
	731	add r0, r0, #0x00000f
	732	strb r1, [r2, r0] @ if (a == 0xe) s68k_regs[0xf] = d;
48e8482f	733	bx lr
4ff2d527	734
0ace9b9a	735	.pool
6cadc2da	736