RaySollium99/picodrive
1
0
Fork 0
mirror of https://github.com/RaySollium99/picodrive.git synced 2025-09-05 15:27:46 -04:00
Code Issues Projects Releases Packages Wiki Activity Actions

cd/Memory.s improvements, reset fixed?

Browse source 
git-svn-id: file:///home/notaz/opt/svn/PicoDrive@71 be3aeb3a-fb24-0410-a615-afba39da0efa
This commit is contained in:
notaz 2007-03-19 22:44:38 +00:00
parent 4ff2d52753
commit 5c69a605ae
8 changed files with 213 additions and 254 deletions
Download patch file Download diff file Expand all files Collapse all files

1
Pico/Pico.c
View file

@ -77,6 +77,7 @@ int PicoReset(int hard)
// reset VDP state, VRAM and PicoMisc // reset VDP state, VRAM and PicoMisc
//memset(&Pico.video,0,sizeof(Pico.video)); //memset(&Pico.video,0,sizeof(Pico.video));
//memset(&Pico.vram,0,sizeof(Pico.vram)); //memset(&Pico.vram,0,sizeof(Pico.vram));
memset(Pico.ioports,0,sizeof(Pico.ioports)); // needed for MCD to reset properly
memset(&Pico.m,0,sizeof(Pico.m)); memset(&Pico.m,0,sizeof(Pico.m));
Pico.video.pending_ints=0; Pico.video.pending_ints=0;
emustatus = 0; emustatus = 0;

4
Pico/cd/LC89510.c
View file

@ -37,9 +37,7 @@ static void CDC_Reset(void)
{ {
// Reseting CDC // Reseting CDC
memset(Pico_mcd->cdc.Buffer, 0, (16 * 1024 * 2) + 2352); memset(Pico_mcd->cdc.Buffer, 0, sizeof(Pico_mcd->cdc.Buffer));
CDC_Update_Header();
Pico_mcd->cdc.COMIN = 0; Pico_mcd->cdc.COMIN = 0;
Pico_mcd->cdc.IFSTAT = 0xFF; Pico_mcd->cdc.IFSTAT = 0xFF;

440
Pico/cd/Memory.s
View file

@ -53,7 +53,7 @@
.long m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram @ - 0xffffff .long m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram, m_m68k_&\on&\sz&_ram @ - 0xffffff
.endm .endm
.macro mk_s68k_jump_table1 on sz @ operation name, size .macro mk_s68k_jump_table on sz @ operation name, size
.long m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg @ 0x000000 - 0x07ffff .long m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg, m_s68k_&\on&\sz&_prg @ 0x000000 - 0x07ffff
.long m_s68k_&\on&\sz&_wordram_2M @ 0x080000 - 0x09ffff .long m_s68k_&\on&\sz&_wordram_2M @ 0x080000 - 0x09ffff
.long m_s68k_&\on&\sz&_wordram_2M @ 0x0a0000 - 0x0bffff .long m_s68k_&\on&\sz&_wordram_2M @ 0x0a0000 - 0x0bffff
@ -61,13 +61,6 @@
.long m_&\on&_null @ 0x0e0000 - 0x0fffff .long m_&\on&_null @ 0x0e0000 - 0x0fffff
.endm .endm
.macro mk_s68k_jump_table2 on sz @ operation name, size
.long m_s68k_&\on&\sz&_backup @ 0xfe0000 - 0xfe7fff
.long m_s68k_&\on&\sz&_backup @ 0xfe8000 - 0xfeffff
.long m_s68k_&\on&\sz&_pcm @ 0xff0000 - 0xff7fff
.long m_s68k_&\on&\sz&_regs @ 0xff8000 - 0xffffff
.endm
@ the jumptables themselves @ the jumptables themselves
m_m68k_read8_table: mk_m68k_jump_table read 8 m_m68k_read8_table: mk_m68k_jump_table read 8
@ -77,25 +70,12 @@ m_m68k_write8_table: mk_m68k_jump_table write 8
m_m68k_write16_table: mk_m68k_jump_table write 16 m_m68k_write16_table: mk_m68k_jump_table write 16
m_m68k_write32_table: mk_m68k_jump_table write 32 m_m68k_write32_table: mk_m68k_jump_table write 32
m_s68k_read8_table: mk_s68k_jump_table read 8
m_s68k_read8_table: m_s68k_read16_table: mk_s68k_jump_table read 16
mk_s68k_jump_table1 read 8 m_s68k_read32_table: mk_s68k_jump_table read 32
mk_s68k_jump_table2 read 8 m_s68k_write8_table: mk_s68k_jump_table write 8
m_s68k_read16_table: m_s68k_write16_table: mk_s68k_jump_table write 16
mk_s68k_jump_table1 read 16 m_s68k_write32_table: mk_s68k_jump_table write 32
mk_s68k_jump_table2 read 16
m_s68k_read32_table:
mk_s68k_jump_table1 read 32
mk_s68k_jump_table2 read 32
m_s68k_write8_table:
mk_s68k_jump_table1 write 8
mk_s68k_jump_table2 write 8
m_s68k_write16_table:
mk_s68k_jump_table1 write 16
mk_s68k_jump_table2 write 16
m_s68k_write32_table:
mk_s68k_jump_table1 write 32
mk_s68k_jump_table2 write 32
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
@ -129,7 +109,7 @@ m_s68k_write32_table:
.extern gfx_cd_read .extern gfx_cd_read
.extern s68k_reg_read16 .extern s68k_reg_read16
.extern SRam .extern SRam
.extern gfx_cd_write .extern gfx_cd_write16
.extern s68k_reg_write8 .extern s68k_reg_write8
@ -223,37 +203,43 @@ PicoWriteM68k32: @ u32 a, u32 d
mk_entry_m68k m_m68k_write32_table mk_entry_m68k m_m68k_write32_table
.macro mk_entry_s68k table .macro mk_entry_s68k on sz
ldr r2, =\table
bic r0, r0, #0xff000000 bic r0, r0, #0xff000000
and r3, r0, #0x00fe0000 cmp r0, #0x00080000
cmp r3, #0x000e0000 blt m_s68k_&\on&\sz&_prg
cmp r0, #0x000e0000
ldrlt r2, =m_s68k_&\on&\sz&_table
andlt r3, r0, #0x000e0000
ldrlt pc, [r2, r3, lsr #15] ldrlt pc, [r2, r3, lsr #15]
add r2, r2, #8*4 @ skip to table2 mov r3, #0x00ff0000
cmp r3, #0x00fe0000 orr r3, r3, #0x00008000
andge r3, r0, #0x00018000 cmp r0, r3
ldrge pc, [r2, r3, lsr #13] bge m_s68k_&\on&\sz&_regs
cmp r0, #0x00ff0000
bge m_s68k_&\on&\sz&_pcm
cmp r0, #0x00fe0000
bge m_s68k_&\on&\sz&_backup
mov r0, #0 mov r0, #0
bx lr bx lr
.endm .endm
PicoReadS68k8: @ u32 a PicoReadS68k8: @ u32 a
mk_entry_s68k m_s68k_read8_table mk_entry_s68k read 8
PicoReadS68k16: @ u32 a PicoReadS68k16: @ u32 a
mk_entry_s68k m_s68k_read16_table mk_entry_s68k read 16
PicoReadS68k32: @ u32 a PicoReadS68k32: @ u32 a
mk_entry_s68k m_s68k_read32_table mk_entry_s68k read 32
PicoWriteS68k8: @ u32 a, u8 d PicoWriteS68k8: @ u32 a, u8 d
mk_entry_s68k m_s68k_write8_table mk_entry_s68k write 8
PicoWriteS68k16: @ u32 a, u16 d PicoWriteS68k16: @ u32 a, u16 d
mk_entry_s68k m_s68k_write16_table mk_entry_s68k write 16
PicoWriteS68k32: @ u32 a, u32 d PicoWriteS68k32: @ u32 a, u32 d
mk_entry_s68k m_s68k_write32_table mk_entry_s68k write 32
.pool .pool
@ -1188,6 +1174,7 @@ m_m68k_write32_system_io:
bx lr bx lr
m_m68k_write32_regs: m_m68k_write32_regs:
bic r0, r0, #1
stmfd sp!,{r0,r1,lr} stmfd sp!,{r0,r1,lr}
mov r1, r1, lsr #24 mov r1, r1, lsr #24
bl m68k_reg_write8 bl m68k_reg_write8
@ -1206,6 +1193,7 @@ m_m68k_write32_regs:
b m68k_reg_write8 b m68k_reg_write8
m_m68k_write32_misc: m_m68k_write32_misc:
bic r0, r0, #1
stmfd sp!,{r0,r1,lr} stmfd sp!,{r0,r1,lr}
mov r1, r1, lsr #16 mov r1, r1, lsr #16
bl OtherWrite16 bl OtherWrite16
@ -1238,46 +1226,49 @@ m_m68k_write32_ram:
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_read8_ram map_addr
ldr r1, =(Pico+0x22200)
eor r0, r0, #1
ldr r1, [r1]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
ldrb r0, [r1, r0]
bx lr
.endm
.macro m_s68k_read8_wordram_2M_decode map_addr
ldr r2, =(Pico+0x22200)
eor r0, r0, #2
ldr r2, [r2]
movs r0, r0, lsr #1 @ +4-6 <<16
add r2, r2, #\map_addr @ map to our address
ldrb r0, [r2, r0]
movcc r0, r0, lsr #4
andcs r0, r0, #0xf
bx lr
.endm
m_s68k_read8_prg: @ 0x000000 - 0x07ffff m_s68k_read8_prg: @ 0x000000 - 0x07ffff
ldr r1, =(Pico+0x22200)
eor r0, r0, #1
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address
ldrb r0, [r1, r0]
bx lr
m_s68k_read8_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_read8_wordram_2M: @ 0x080000 - 0x0bffff
ldr r1, =(Pico+0x22200) m_s68k_read8_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
eor r0, r0, #1 m_s68k_read8_ram 0x020000
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
ldrb r0, [r1, r0]
bx lr
m_s68k_read8_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_read8_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
m_s68k_read8_wordram_2M_decode 0x080000 @ + ^ / 2
m_s68k_read8_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff m_s68k_read8_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
mov r0, #0 m_s68k_read8_wordram_2M_decode 0x0a0000 @ + ^ / 2
bx lr @ TODO
m_s68k_read8_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_read8_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r1, =(Pico+0x22200) m_s68k_read8_ram 0
ldr r1, [r1]
eor r0, r0, #1
ldrb r0, [r1, r0]
bx lr
m_s68k_read8_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r1, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r1, [r1]
eor r0, r0, #1
ldrb r0, [r1, r0]
bx lr
m_s68k_read8_backup: @ 0xfe0000 - 0xfe3fff (repeated?) m_s68k_read8_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
@ -1286,7 +1277,7 @@ m_s68k_read8_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
mov r0, r0, lsr #1 mov r0, r0, lsr #1
ldr r1, [r1] ldr r1, [r1]
bic r0, r0, #0xff0000 bic r0, r0, #0xff0000
bic r0, r0, #0x00fe00 bic r0, r0, #0x00e000
add r1, r1, #0x110000 add r1, r1, #0x110000
add r1, r1, #0x000200 add r1, r1, #0x000200
ldrb r0, [r1, r0] ldrb r0, [r1, r0]
@ -1352,45 +1343,46 @@ m_s68k_read8_regs:
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_read16_ram map_addr
ldr r1, =(Pico+0x22200)
bic r0, r0, #1
ldr r1, [r1]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
ldrh r0, [r1, r0]
bx lr
.endm
.macro m_s68k_read16_wordram_2M_decode map_addr
ldr r2, =(Pico+0x22200)
eor r0, r0, #2
ldr r2, [r2]
mov r0, r0, lsr #1 @ +4-6 <<16
add r2, r2, #\map_addr @ map to our address
ldrb r0, [r2, r0]
orr r0, r0, r0, lsl #4
bic r0, r0, #0xf0
bx lr
.endm
m_s68k_read16_prg: @ 0x000000 - 0x07ffff m_s68k_read16_prg: @ 0x000000 - 0x07ffff
ldr r1, =(Pico+0x22200)
bic r0, r0, #1
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address
ldrh r0, [r1, r0]
bx lr
m_s68k_read16_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_read16_wordram_2M: @ 0x080000 - 0x0bffff
ldr r1, =(Pico+0x22200) m_s68k_read16_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
bic r0, r0, #1 m_s68k_read16_ram 0x020000
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
ldrh r0, [r1, r0]
bx lr
m_s68k_read16_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_read16_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
m_s68k_read16_wordram_2M_decode 0x080000
m_s68k_read16_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff m_s68k_read16_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
mov r0, #0 m_s68k_read16_wordram_2M_decode 0x0a0000
bx lr @ TODO
m_s68k_read16_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_read16_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r1, =(Pico+0x22200) m_s68k_read16_ram 0
ldr r1, [r1]
bic r0, r0, #1
ldrh r0, [r1, r0]
bx lr
m_s68k_read16_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r1, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r1, [r1]
bic r0, r0, #1
ldrh r0, [r1, r0]
bx lr
@ m_s68k_read16_backup: @ 0xfe0000 - 0xfe3fff (repeated?) @ m_s68k_read16_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
@ -1419,45 +1411,52 @@ m_s68k_read16_regs:
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_read32_ram map_addr
ldr r1, =(Pico+0x22200)
bic r0, r0, #1
ldr r1, [r1]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
m_read32_gen
bx lr
.endm
.macro m_s68k_read32_wordram_2M_decode map_addr
ldr r2, =(Pico+0x22200)
eor r0, r0, #2
ldr r2, [r2]
mov r0, r0, lsr #1 @ +4-6 <<16
add r2, r2, #\map_addr @ map to our address
ldrb r1, [r2, r0]!
tst r0, #1
ldrneb r0, [r2, #-1]
ldreqb r0, [r2, #2]
orr r1, r1, r1, lsl #4
bic r1, r1, #0xf0
orr r0, r0, r0, lsl #4
bic r0, r0, #0xf0
orr r0, r0, r1, lsl #16
bx lr
.endm
m_s68k_read32_prg: @ 0x000000 - 0x07ffff m_s68k_read32_prg: @ 0x000000 - 0x07ffff
ldr r1, =(Pico+0x22200)
bic r0, r0, #1
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address
m_read32_gen
bx lr
m_s68k_read32_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_read32_wordram_2M: @ 0x080000 - 0x0bffff
ldr r1, =(Pico+0x22200) m_s68k_read32_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
bic r0, r0, #1 m_s68k_read32_ram 0x020000
ldr r1, [r1]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
m_read32_gen
bx lr
m_s68k_read32_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_read32_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
m_s68k_read32_wordram_2M_decode 0x080000
m_s68k_read32_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff m_s68k_read32_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
mov r0, #0 m_s68k_read32_wordram_2M_decode 0x0a0000
bx lr @ TODO
m_s68k_read32_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_read32_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r1, =(Pico+0x22200) m_s68k_read32_ram 0
ldr r1, [r1]
bic r0, r0, #1
m_read32_gen
bx lr
m_s68k_read32_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r1, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r1, [r1]
bic r0, r0, #1
m_read32_gen
bx lr
m_s68k_read32_backup: @ 0xfe0000 - 0xfe3fff (repeated?) m_s68k_read32_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
@ -1519,22 +1518,22 @@ m_s68k_read32_regs_gfx:
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_write8_ram map_addr
ldr r2, =(Pico+0x22200)
eor r0, r0, #1
ldr r2, [r2]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
strb r1, [r2, r0]
bx lr
.endm
m_s68k_write8_prg: @ 0x000000 - 0x07ffff m_s68k_write8_prg: @ 0x000000 - 0x07ffff
ldr r2, =(Pico+0x22200)
eor r0, r0, #1
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address
strb r1, [r2, r0]
bx lr
m_s68k_write8_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_write8_wordram_2M: @ 0x080000 - 0x0bffff
ldr r2, =(Pico+0x22200) m_s68k_write8_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
eor r0, r0, #1 m_s68k_write8_ram 0x020000
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
strb r1, [r2, r0]
bx lr
m_s68k_write8_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_write8_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
@ -1543,20 +1542,7 @@ m_s68k_write8_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
m_s68k_write8_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_write8_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r2, =(Pico+0x22200) m_s68k_write8_ram 0
ldr r2, [r2]
eor r0, r0, #1
strb r1, [r2, r0]
bx lr
m_s68k_write8_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r2, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r2, [r2]
eor r0, r0, #1
strb r1, [r2, r0]
bx lr
m_s68k_write8_backup: @ 0xfe0000 - 0xfe3fff (repeated?) m_s68k_write8_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
@ -1565,7 +1551,7 @@ m_s68k_write8_backup: @ 0xfe0000 - 0xfe3fff (repeated?)
mov r0, r0, lsr #1 mov r0, r0, lsr #1
ldr r2, [r2] ldr r2, [r2]
bic r0, r0, #0xff0000 bic r0, r0, #0xff0000
bic r0, r0, #0x00fe00 bic r0, r0, #0x00e000
add r2, r2, #0x110000 add r2, r2, #0x110000
add r2, r2, #0x000200 add r2, r2, #0x000200
strb r1, [r2, r0] strb r1, [r2, r0]
@ -1608,29 +1594,31 @@ m_s68k_write8_regs:
bxne lr bxne lr
sub r2, r0, #0x58 sub r2, r0, #0x58
cmp r2, #0x10 cmp r2, #0x10
blo gfx_cd_write bhs s68k_reg_write8
b s68k_reg_write8 bic r0, r0, #1
orr r1, r1, r1, lsl #8
b gfx_cd_write16
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_write16_ram map_addr
ldr r2, =(Pico+0x22200)
bic r0, r0, #1
ldr r2, [r2]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
strh r1, [r2, r0]
bx lr
.endm
m_s68k_write16_prg: @ 0x000000 - 0x07ffff m_s68k_write16_prg: @ 0x000000 - 0x07ffff
ldr r2, =(Pico+0x22200)
bic r0, r0, #1
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address
strh r1, [r2, r0]
bx lr
m_s68k_write16_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_write16_wordram_2M: @ 0x080000 - 0x0bffff
ldr r2, =(Pico+0x22200) m_s68k_write16_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
bic r0, r0, #1 m_s68k_write16_ram 0x020000
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
strh r1, [r2, r0]
bx lr
m_s68k_write16_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_write16_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
@ -1639,20 +1627,7 @@ m_s68k_write16_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
m_s68k_write16_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_write16_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r2, =(Pico+0x22200) m_s68k_write16_ram 0
ldr r2, [r2]
bic r0, r0, #1
strh r1, [r2, r0]
bx lr
m_s68k_write16_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r2, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r2, [r2]
bic r0, r0, #1
strh r1, [r2, r0]
bx lr
@ m_s68k_write16_backup: @ m_s68k_write16_backup:
@ -1666,47 +1641,51 @@ m_s68k_write16_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
m_s68k_write16_regs: m_s68k_write16_regs:
bic r0, r0, #0xff0000 bic r0, r0, #0xff0000
bic r0, r0, #0x008000 bic r0, r0, #0x008000
bic r0, r0, #1
tst r0, #0x7e00 tst r0, #0x7e00
movne r0, #0 movne r0, #0
bxne lr bxne lr
cmp r0, #0x0e
beq m_s68k_write16_regs_spec
sub r2, r0, #0x58 sub r2, r0, #0x58
cmp r2, #0x10 cmp r2, #0x10
blo gfx_cd_write16
and r3, r1, #0xff and r3, r1, #0xff
add r2, r0, #1 add r2, r0, #1
blo m_s68k_write16_regs_gfx
stmfd sp!,{r2,r3,lr} stmfd sp!,{r2,r3,lr}
mov r1, r1, lsr #8 mov r1, r1, lsr #8
bl s68k_reg_write8 bl s68k_reg_write8
ldmfd sp!,{r0,r1,lr} ldmfd sp!,{r0,r1,lr}
b s68k_reg_write8 b s68k_reg_write8
m_s68k_write16_regs_gfx: m_s68k_write16_regs_spec: @ special case
stmfd sp!,{r2,r3,lr} ldr r2, =(Pico+0x22200)
mov r1, r1, lsr #8 mov r0, #0x110000
bl gfx_cd_write ldr r2, [r2]
ldmfd sp!,{r0,r1,lr} add r0, r0, #0x00000f
b gfx_cd_write strb r1, [r2, r0] @ if (a == 0xe) s68k_regs[0xf] = d;
bxeq lr
@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
.macro m_s68k_write32_ram map_addr
ldr r2, =(Pico+0x22200)
bic r0, r0, #1
ldr r2, [r2]
.if \map_addr
add r0, r0, #\map_addr @ map to our address
.endif
m_write32_gen
bx lr
.endm
m_s68k_write32_prg: @ 0x000000 - 0x07ffff m_s68k_write32_prg: @ 0x000000 - 0x07ffff
ldr r2, =(Pico+0x22200)
bic r0, r0, #1
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address
m_write32_gen
bx lr
m_s68k_write32_wordram_2M: @ 0x080000 - 0x0bffff m_s68k_write32_wordram_2M: @ 0x080000 - 0x0bffff
ldr r2, =(Pico+0x22200) m_s68k_write32_wordram_1M_b1: @ 0x0c0000 - 0x0dffff, maps to 0x0e0000
bic r0, r0, #1 m_s68k_write32_ram 0x020000
ldr r2, [r2]
add r0, r0, #0x020000 @ map to our address (0x0a0000)
m_write32_gen
bx lr
m_s68k_write32_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff m_s68k_write32_wordram_2M_decode_b0: @ 0x080000 - 0x0bffff
@ -1715,20 +1694,7 @@ m_s68k_write32_wordram_2M_decode_b1: @ 0x080000 - 0x0bffff
m_s68k_write32_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :) m_s68k_write32_wordram_1M_b0: @ 0x0c0000 - 0x0dffff (same as our offset :)
ldr r2, =(Pico+0x22200) m_s68k_write32_ram 0
ldr r2, [r2]
bic r0, r0, #1
m_write32_gen
bx lr
m_s68k_write32_wordram_1M_b1: @ 0x0c0000 - 0x0dffff
ldr r2, =(Pico+0x22200)
add r0, r0, #0x020000 @ map to our offset, which is 0x0e0000
ldr r2, [r2]
bic r0, r0, #1
m_write32_gen
bx lr
m_s68k_write32_backup: m_s68k_write32_backup:
@ -1783,6 +1749,7 @@ m_s68k_write32_pcm_reg:
m_s68k_write32_regs: m_s68k_write32_regs:
bic r0, r0, #0xff0000 bic r0, r0, #0xff0000
bic r0, r0, #0x008000 bic r0, r0, #0x008000
bic r0, r0, #1
tst r0, #0x7e00 tst r0, #0x7e00
movne r0, #0 movne r0, #0
bxne lr bxne lr
@ -1808,20 +1775,11 @@ m_s68k_write32_regs:
b s68k_reg_write8 b s68k_reg_write8
m_s68k_write32_regs_gfx: m_s68k_write32_regs_gfx:
stmfd sp!,{r0,r1,lr} mov r3, r1
mov r1, r1, lsr #24 add r2, r0, #2
bl gfx_cd_write stmfd sp!,{r2,r3,lr}
ldr r0, [sp]
ldr r1, [sp, #4]
add r0, r0, #1
mov r1, r1, lsr #16 mov r1, r1, lsr #16
bl gfx_cd_write bl gfx_cd_write16
ldr r0, [sp]
ldr r1, [sp, #4]
add r0, r0, #2
mov r1, r1, lsr #8
bl gfx_cd_write
ldmfd sp!,{r0,r1,lr} ldmfd sp!,{r0,r1,lr}
add r0, r0, #3 b gfx_cd_write16
b gfx_cd_write

10
Pico/cd/Pico.c
View file

@ -30,24 +30,24 @@ void PicoExitMCD(void)
int PicoResetMCD(int hard) int PicoResetMCD(int hard)
{ {
memset(Pico_mcd->prg_ram, 0, sizeof(Pico_mcd->prg_ram));
memset(Pico_mcd->word_ram2M, 0, sizeof(Pico_mcd->word_ram2M));
memset(Pico_mcd->pcm_ram, 0, sizeof(Pico_mcd->pcm_ram));
if (hard) { if (hard) {
int fmt_size = sizeof(formatted_bram); int fmt_size = sizeof(formatted_bram);
memset(Pico_mcd->prg_ram, 0, sizeof(Pico_mcd->prg_ram));
memset(Pico_mcd->word_ram2M, 0, sizeof(Pico_mcd->word_ram2M));
memset(Pico_mcd->pcm_ram, 0, sizeof(Pico_mcd->pcm_ram));
memset(Pico_mcd->bram, 0, sizeof(Pico_mcd->bram)); memset(Pico_mcd->bram, 0, sizeof(Pico_mcd->bram));
memcpy(Pico_mcd->bram + sizeof(Pico_mcd->bram) - fmt_size, formatted_bram, fmt_size); memcpy(Pico_mcd->bram + sizeof(Pico_mcd->bram) - fmt_size, formatted_bram, fmt_size);
} }
memset(Pico_mcd->s68k_regs, 0, sizeof(Pico_mcd->s68k_regs)); memset(Pico_mcd->s68k_regs, 0, sizeof(Pico_mcd->s68k_regs));
memset(&Pico_mcd->pcm, 0, sizeof(Pico_mcd->pcm)); memset(&Pico_mcd->pcm, 0, sizeof(Pico_mcd->pcm));
memset(&Pico_mcd->m, 0, sizeof(Pico_mcd->m));
*(unsigned int *)(Pico_mcd->bios + 0x70) = 0xffffffff; // reset hint vector (simplest way to implement reg6) *(unsigned int *)(Pico_mcd->bios + 0x70) = 0xffffffff; // reset hint vector (simplest way to implement reg6)
Pico_mcd->m.state_flags |= 2; // s68k reset pending Pico_mcd->m.state_flags |= 2; // s68k reset pending
Pico_mcd->s68k_regs[3] = 1; // 2M word RAM mode with m68k access after reset Pico_mcd->s68k_regs[3] = 1; // 2M word RAM mode with m68k access after reset
Pico_mcd->m.counter75hz = 0;
LC89510_Reset();
Reset_CD(); Reset_CD();
LC89510_Reset();
gfx_cd_reset(); gfx_cd_reset();
#ifdef _ASM_CD_MEMORY_C #ifdef _ASM_CD_MEMORY_C
PicoMemResetCD(1); PicoMemResetCD(1);

2
Pico/cd/cd_sys.c
View file

@ -208,8 +208,10 @@ void Reset_CD(void)
{ {
Pico_mcd->scd.Cur_Track = 0; Pico_mcd->scd.Cur_Track = 0;
Pico_mcd->scd.Cur_LBA = -150; Pico_mcd->scd.Cur_LBA = -150;
Pico_mcd->scd.Status_CDC &= ~1;
Pico_mcd->scd.Status_CDD = READY; Pico_mcd->scd.Status_CDD = READY;
Pico_mcd->scd.CDD_Complete = 0; Pico_mcd->scd.CDD_Complete = 0;
Pico_mcd->scd.File_Add_Delay = 0;
} }

2
Pico/cd/cd_sys.h
View file

@ -55,7 +55,7 @@ typedef struct {
unsigned int Cur_Track; unsigned int Cur_Track;
int File_Add_Delay; int File_Add_Delay;
char CDD_Complete; char CDD_Complete;
int pad[6]; int pad[7];
} _scd; } _scd;

6
Pico/cd/gfx_cd.c
View file

@ -154,9 +154,9 @@ unsigned int gfx_cd_read(unsigned int a)
return 0; return 0;
} }
void gfx_cd_write(unsigned int a, unsigned int d) void gfx_cd_write16(unsigned int a, unsigned int d)
{ {
dprintf("gfx_cd_write(%x, %04x)", a, d); dprintf("gfx_cd_write16(%x, %04x)", a, d);
switch (a) { switch (a) {
case 0x58: // .Reg_Stamp_Size case 0x58: // .Reg_Stamp_Size
@ -193,7 +193,7 @@ void gfx_cd_write(unsigned int a, unsigned int d)
gfx_cd_start(); gfx_cd_start();
return; return;
default: dprintf("gfx_cd_write FIXME: unexpected address: %02x", a); return; default: dprintf("gfx_cd_write16 FIXME: unexpected address: %02x", a); return;
} }
} }

2
Pico/cd/gfx_cd.h
View file

@ -36,7 +36,7 @@ typedef struct
void gfx_cd_update(void); void gfx_cd_update(void);
unsigned int gfx_cd_read(unsigned int a); unsigned int gfx_cd_read(unsigned int a);
void gfx_cd_write(unsigned int a, unsigned int d); void gfx_cd_write16(unsigned int a, unsigned int d);
void gfx_cd_reset(void); void gfx_cd_reset(void);