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

@*
@* Memory I/O handlers for Sega/Mega CD emulation
@* (C) notaz, 2007-2009
@*
@* This work is licensed under the terms of MAME license.
@* See COPYING file in the top-level directory.
@*

.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_detect
.extern gfx_cd_read
.extern gfx_cd_write16
.extern PicoCpuCS68k
.extern PicoRead8_io
.extern PicoRead16_io
.extern PicoWrite8_io
.extern PicoWrite16_io
.extern m68k_comm_check


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

@ 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:                     @ FIXME: sync with C
    add     r2, r1, #0x110000
    ldrb    r1, [r2, #3]
    add     r2, r2, #0x002200
    ldr     r2, [r2, #4]
    and     r1, r1, #0xc7
    tst     r2, #2                    @ DMNA pending?
    bicne   r1, r1, #1
    orrne   r1, r1, #2
    b       m68k_comm_check
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    r1, [r1, r0]
    b       m68k_comm_check


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


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:                    @ FIXME: out of sync from C
    add     r3, r1, #0x110000
    ldrb    r1, [r3, #2]
    ldrb    r2, [r3, #3]
    add     r3, r3, #0x002200
    ldr     r3, [r3, #4]
    and     r2, r2, #0xc7
    orr     r1, r2, r1, lsl #8
    tst     r3, #2                    @ DMNA pending?
    bicne   r1, r1, #1
    orrne   r1, r1, #2
    b       m68k_comm_check
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     r2, r1, lsr #8
    and     r1, r1, #0xff
    orr     r1, r2, r1, lsl #8
    b       m68k_comm_check


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


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
    mov     r1, r1, lsr #8
    b       m68k_reg_write8


@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
@                                   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

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