[picodrive.git] / m68kif_cyclone.s

@ vim:filetype=armasm

.equ M68K_MEM_SHIFT, 16

.global cyclone_checkpc
.global cyclone_fetch8
.global cyclone_fetch16
.global cyclone_fetch32
.global cyclone_read8
.global cyclone_read16
.global cyclone_read32
.global cyclone_write8
.global cyclone_write16
.global cyclone_write32

@ Warning: here we abuse the fact that we are only called
@ from Cyclone, and assume that r7 contains context pointer.
cyclone_checkpc:
    ldr     r1, [r7, #0x60]  @ membase
    sub     r0, r0, r1
    bic     r0, r0, #0xff000000
    bics    r0, r0, #1
    beq     crashed

    ldr     r1, [r7, #0x6c]  @ read16 map
    mov     r2, r0, lsr #M68K_MEM_SHIFT
    ldr     r1, [r1, r2, lsl #2]
    movs    r1, r1, lsl #1
    bcs     crashed

    str     r1, [r7, #0x60]  @ membase
    add     r0, r0, r1
    bx      lr

crashed:
    stmfd   sp!,{lr}
    mov     r1, r7
    bl      cyclone_crashed
    ldr     r0, [r7, #0x40]  @ reload PC + membase
    ldmfd   sp!,{pc}


cyclone_read8: @ u32 a
cyclone_fetch8:
    bic     r0, r0, #0xff000000
    ldr     r1, [r7, #0x68]  @ read8 map
    mov     r2, r0, lsr #M68K_MEM_SHIFT
    ldr     r1, [r1, r2, lsl #2]
    eor     r2, r0, #1
    movs    r1, r1, lsl #1
    ldrccb  r0, [r1, r2]
    bxcc    lr
    bx      r1


cyclone_read16: @ u32 a
cyclone_fetch16:
    bic     r0, r0, #0xff000000
    ldr     r1, [r7, #0x6c]  @ read16 map
    mov     r2, r0, lsr #M68K_MEM_SHIFT
    ldr     r1, [r1, r2, lsl #2]
    bic     r0, r0, #1
    movs    r1, r1, lsl #1
    ldrcch  r0, [r1, r0]
    bxcc    lr
    bx      r1


cyclone_read32: @ u32 a
cyclone_fetch32:
    bic     r0, r0, #0xff000000
    ldr     r1, [r7, #0x6c]  @ read16 map
    mov     r2, r0, lsr #M68K_MEM_SHIFT
    ldr     r1, [r1, r2, lsl #2]
    bic     r0, r0, #1
    movs    r1, r1, lsl #1
    ldrcch  r0, [r1, r0]!
    ldrcch  r1, [r1, #2]
    orrcc   r0, r1, r0, lsl #16
    bxcc    lr

    stmfd   sp!,{r0,r1,lr}
    mov     lr, pc
    bx      r1
    mov     r2, r0, lsl #16
    ldmia   sp, {r0,r1}
    str     r2, [sp]
    add     r0, r0, #2
    mov     lr, pc
    bx      r1
    ldr     r1, [sp]
    mov     r0, r0, lsl #16
    orr     r0, r1, r0, lsr #16
    ldmfd   sp!,{r1,r2,pc}


cyclone_write8: @ u32 a, u8 d
    bic     r0, r0, #0xff000000
    ldr     r2, [r7, #0x74]  @ write8 map
    mov     r3, r0, lsr #M68K_MEM_SHIFT
    ldr     r2, [r2, r3, lsl #2]
    eor     r3, r0, #1
    movs    r2, r2, lsl #1
    strccb  r1, [r2, r3]
    bxcc    lr
    bx      r2


cyclone_write16: @ u32 a, u16 d
    bic     r0, r0, #0xff000000
    ldr     r2, [r7, #0x78]  @ write16 map
    mov     r3, r0, lsr #M68K_MEM_SHIFT
    ldr     r2, [r2, r3, lsl #2]
    bic     r0, r0, #1
    movs    r2, r2, lsl #1
    strcch  r1, [r2, r0]
    bxcc    lr
    bx      r2


cyclone_write32: @ u32 a, u32 d
    bic     r0, r0, #0xff000000
    ldr     r2, [r7, #0x78]  @ write16 map
    mov     r3, r0, lsr #M68K_MEM_SHIFT
    ldr     r2, [r2, r3, lsl #2]
    bic     r0, r0, #1
    movs    r2, r2, lsl #1
    movcc   r3, r1, lsr #16
    strcch  r3, [r2, r0]!
    strcch  r1, [r2, #2]
    bxcc    lr

    stmfd   sp!,{r0-r2,lr}
    mov     r1, r1, lsr #16
    mov     lr, pc
    bx      r2
    ldmfd   sp!,{r0-r2,lr}
    add     r0, r0, #2
    bx      r2
Commit	Line	Data
	1	@ vim:filetype=armasm
	2
	3	.equ M68K_MEM_SHIFT, 16
	4
	5	.global cyclone_checkpc
	6	.global cyclone_fetch8
	7	.global cyclone_fetch16
	8	.global cyclone_fetch32
	9	.global cyclone_read8
	10	.global cyclone_read16
	11	.global cyclone_read32
	12	.global cyclone_write8
	13	.global cyclone_write16
	14	.global cyclone_write32
	15
	16	@ Warning: here we abuse the fact that we are only called
	17	@ from Cyclone, and assume that r7 contains context pointer.
	18	cyclone_checkpc:
	19	ldr r1, [r7, #0x60] @ membase
	20	sub r0, r0, r1
	21	bic r0, r0, #0xff000000
	22	bics r0, r0, #1
	23	beq crashed
	24
	25	ldr r1, [r7, #0x6c] @ read16 map
	26	mov r2, r0, lsr #M68K_MEM_SHIFT
	27	ldr r1, [r1, r2, lsl #2]
	28	movs r1, r1, lsl #1
	29	bcs crashed
	30
	31	str r1, [r7, #0x60] @ membase
	32	add r0, r0, r1
	33	bx lr
	34
	35	crashed:
	36	stmfd sp!,{lr}
	37	mov r1, r7
	38	bl cyclone_crashed
	39	ldr r0, [r7, #0x40] @ reload PC + membase
	40	ldmfd sp!,{pc}
	41
	42
	43	cyclone_read8: @ u32 a
	44	cyclone_fetch8:
	45	bic r0, r0, #0xff000000
	46	ldr r1, [r7, #0x68] @ read8 map
	47	mov r2, r0, lsr #M68K_MEM_SHIFT
	48	ldr r1, [r1, r2, lsl #2]
	49	eor r2, r0, #1
	50	movs r1, r1, lsl #1
	51	ldrccb r0, [r1, r2]
	52	bxcc lr
	53	bx r1
	54
	55
	56	cyclone_read16: @ u32 a
	57	cyclone_fetch16:
	58	bic r0, r0, #0xff000000
	59	ldr r1, [r7, #0x6c] @ read16 map
	60	mov r2, r0, lsr #M68K_MEM_SHIFT
	61	ldr r1, [r1, r2, lsl #2]
	62	bic r0, r0, #1
	63	movs r1, r1, lsl #1
	64	ldrcch r0, [r1, r0]
	65	bxcc lr
	66	bx r1
	67
	68
	69	cyclone_read32: @ u32 a
	70	cyclone_fetch32:
	71	bic r0, r0, #0xff000000
	72	ldr r1, [r7, #0x6c] @ read16 map
	73	mov r2, r0, lsr #M68K_MEM_SHIFT
	74	ldr r1, [r1, r2, lsl #2]
	75	bic r0, r0, #1
	76	movs r1, r1, lsl #1
	77	ldrcch r0, [r1, r0]!
	78	ldrcch r1, [r1, #2]
	79	orrcc r0, r1, r0, lsl #16
	80	bxcc lr
	81
	82	stmfd sp!,{r0,r1,lr}
	83	mov lr, pc
	84	bx r1
	85	mov r2, r0, lsl #16
	86	ldmia sp, {r0,r1}
	87	str r2, [sp]
	88	add r0, r0, #2
	89	mov lr, pc
	90	bx r1
	91	ldr r1, [sp]
	92	mov r0, r0, lsl #16
	93	orr r0, r1, r0, lsr #16
	94	ldmfd sp!,{r1,r2,pc}
	95
	96
	97	cyclone_write8: @ u32 a, u8 d
	98	bic r0, r0, #0xff000000
	99	ldr r2, [r7, #0x74] @ write8 map
	100	mov r3, r0, lsr #M68K_MEM_SHIFT
	101	ldr r2, [r2, r3, lsl #2]
	102	eor r3, r0, #1
	103	movs r2, r2, lsl #1
	104	strccb r1, [r2, r3]
	105	bxcc lr
	106	bx r2
	107
	108
	109	cyclone_write16: @ u32 a, u16 d
	110	bic r0, r0, #0xff000000
	111	ldr r2, [r7, #0x78] @ write16 map
	112	mov r3, r0, lsr #M68K_MEM_SHIFT
	113	ldr r2, [r2, r3, lsl #2]
	114	bic r0, r0, #1
	115	movs r2, r2, lsl #1
	116	strcch r1, [r2, r0]
	117	bxcc lr
	118	bx r2
	119
	120
	121	cyclone_write32: @ u32 a, u32 d
	122	bic r0, r0, #0xff000000
	123	ldr r2, [r7, #0x78] @ write16 map
	124	mov r3, r0, lsr #M68K_MEM_SHIFT
	125	ldr r2, [r2, r3, lsl #2]
	126	bic r0, r0, #1
	127	movs r2, r2, lsl #1
	128	movcc r3, r1, lsr #16
	129	strcch r3, [r2, r0]!
	130	strcch r1, [r2, #2]
	131	bxcc lr
	132
	133	stmfd sp!,{r0-r2,lr}
	134	mov r1, r1, lsr #16
	135	mov lr, pc
	136	bx r2
	137	ldmfd sp!,{r0-r2,lr}
	138	add r0, r0, #2
	139	bx r2
	140