74315e446dcd4f800d13a2f6295d125bb5099a0e
[picodrive.git] / memory_arm.s
1 @ vim:filetype=armasm
2
3 @ Memory I/O handlers for Sega/Mega CD emulation
4 @ (c) Copyright 2007-2009, Grazvydas "notaz" Ignotas
5
6
7 .equiv PCM_STEP_SHIFT, 11
8
9 .text
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
47
48 @ externs, just for reference
49 .extern Pico
50 .extern Read_CDC_Host
51 .extern m68k_reg_write8
52 .extern s68k_reg_read16
53 .extern s68k_reg_write8
54 .extern s68k_poll_adclk
55 .extern s68k_poll_detect
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
63
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
111 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
112
113
114 m_read_null:
115     mov     r0, #0
116     bx      lr
117
118
119 PicoReadM68k8_cell0:                    @ 0x220000 - 0x23ffff, cell arranged
120     mov     r3, #0x0c0000
121     b       0f
122
123 PicoReadM68k8_cell1:                    @ 0x220000 - 0x23ffff, cell arranged
124     mov     r3, #0x0e0000
125 0:
126     cell_map
127     ldr     r1, =(Pico+0x22200)
128     add     r0, r0, r3
129     ldr     r1, [r1]
130     eor     r0, r0, #1
131     ldrb    r0, [r1, r0]
132     bx      lr
133
134
135 PicoReadM68k8_io:
136     and     r1, r0, #0xff00
137     cmp     r1, #0x2000               @ a120xx?
138     bne     PicoRead8_io
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
162     ldr     r0, [r1, #0x30]
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]
178     add     r1, r1, #0x002200
179     ldr     r1, [r1, #4]
180     and     r0, r0, #0xc7
181     tst     r1, #2                    @ DMNA pending?
182     bxeq    lr
183     bic     r0, r0, #1
184     orr     r0, r0, #2
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
224
225 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
226
227
228 PicoReadM68k16_cell0:                   @ 0x220000 - 0x23ffff, cell arranged
229     mov     r3, #0x0c0000
230     b       0f
231
232 PicoReadM68k16_cell1:                   @ 0x220000 - 0x23ffff, cell arranged
233     mov     r3, #0x0e0000
234 0:
235     cell_map
236     ldr     r1, =(Pico+0x22200)
237     add     r0, r0, r3
238     ldr     r1, [r1]
239     bic     r0, r0, #1
240     ldrh    r0, [r1, r0]
241     bx      lr
242
243
244 PicoReadM68k16_io:
245     and     r1, r0, #0xff00
246     cmp     r1, #0x2000               @ a120xx
247     bne     PicoRead16_io
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
265     ldr     r0, [r1, #0x30]
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]
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
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
313 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
314
315
316 PicoWriteM68k8_cell0:                   @ 0x220000 - 0x23ffff, cell arranged
317     mov     r12,#0x0c0000
318     b       0f
319
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]
330     bx      lr
331
332
333 PicoWriteM68k8_io:
334     and     r2, r0, #0xff00
335     cmp     r2, #0x2000                 @ a120xx?
336     beq     m68k_reg_write8
337     b       PicoWrite8_io
338
339
340 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
341
342
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
352     ldr     r1, =(Pico+0x22200)
353     add     r0, r0, r12
354     ldr     r1, [r1]
355     bic     r0, r0, #1
356     strh    r3, [r1, r0]
357     bx      lr
358
359
360 PicoWriteM68k16_io:
361     and     r2, r0, #0xff00
362     cmp     r2, #0x2000                 @ a120xx?
363     bne     PicoWrite16_io
364
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
376
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]
393     bx      lr
394
395
396 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
397 @                                   Sub 68k
398 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
399
400
401 PicoReadS68k8_dec0:                     @ 0x080000 - 0x0bffff
402     mov     r3, #0x080000               @ + ^ / 2
403     b       0f
404
405 PicoReadS68k8_dec1:
406     mov     r3, #0x0a0000               @ + ^ / 2
407 0:
408     ldr     r2, =(Pico+0x22200)
409     eor     r0, r0, #2
410     ldr     r2, [r2]
411     movs    r0, r0, lsr #1              @ +4-6 <<16
412     add     r2, r2, r3                  @ map to our address
413     ldrb    r0, [r2, r0]
414     movcc   r0, r0, lsr #4
415     andcs   r0, r0, #0xf
416     bx      lr
417
418
419 PicoReadS68k8_pr:
420     and     r2, r0, #0xfe00
421     cmp     r2, #0x8000
422     bne     m_s68k_read8_pcm
423
424 m_s68k_read8_regs:
425     bic     r0, r0, #0xff0000
426     bic     r0, r0, #0x008000
427     sub     r2, r0, #0x0e
428     cmp     r2, #(0x30-0x0e)
429     blo     m_s68k_read8_comm
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
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
451
452 m_s68k_read8_pcm:
453     tst     r0, #0x8000
454     bne     m_read_null
455
456     @ must not trash r3 and r12
457     ldr     r1, =(Pico+0x22200)
458     bic     r0, r0, #0xff0000
459 @    bic     r0, r0, #0x008000
460     ldr     r1, [r1]
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
476     bx      lr
477
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
488
489
490 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
491
492
493 PicoReadS68k16_dec0:                    @ 0x080000 - 0x0bffff
494     mov     r3, #0x080000               @ + ^ / 2
495     b       0f
496
497 PicoReadS68k16_dec1:
498     mov     r3, #0x0a0000               @ + ^ / 2
499 0:
500     ldr     r2, =(Pico+0x22200)
501     eor     r0, r0, #2
502     ldr     r2, [r2]
503     mov     r0, r0, lsr #1              @ +4-6 <<16
504     add     r2, r2, r3                  @ map to our address
505     ldrb    r0, [r2, r0]
506     orr     r0, r0, r0, lsl #4
507     bic     r0, r0, #0xf0
508     bx      lr
509
510
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
516
517 m_s68k_read16_regs:
518     bic     r0, r0, #0xff0000
519     bic     r0, r0, #0x008000
520     bic     r0, r0, #0x000001
521     sub     r2, r0, #0x58
522     cmp     r2, #0x10
523     blo     gfx_cd_read
524     cmp     r0, #8
525     bne     s68k_reg_read16
526     mov     r0, #1
527     b       Read_CDC_Host
528
529
530 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
531
532
533 .macro m_s68k_write8_2M_decode
534     ldr     r2, =(Pico+0x22200)
535     eor     r0, r0, #2
536     ldr     r2, [r2]                    @ Pico.rom
537     movs    r0, r0, lsr #1              @ +4-6 <<16
538     add     r2, r2, r3                  @ map to our address
539 .endm
540
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
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
563     strneb  r3, [r2]
564     bx      lr
565
566 PicoWriteS68k8_dec_m1b0:                @ underwrite
567     mov     r3, #0x080000
568     b       0f
569
570 PicoWriteS68k8_dec_m1b1:
571     mov     r3, #0x0a0000
572 0:
573     ands    r1, r1, #0x0f
574     bxeq    lr
575     m_s68k_write8_2M_decode
576     ldrb    r0, [r2, r0]!
577     movcc   r1, r1, lsl #4
578     andcc   r3, r0, #0x0f
579     andcs   r3, r0, #0xf0
580     teq     r3, r0
581     bxne    lr
582     orr     r3, r3, r1
583     strneb  r3, [r2]
584     bx      lr
585
586
587 PicoWriteS68k8_pr:
588     and     r2, r0, #0xfe00
589     cmp     r2, #0x8000
590     bne     m_s68k_write8_pcm
591
592 m_s68k_write8_regs:
593     bic     r0, r0, #0xff0000
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
604
605
606 m_s68k_write8_pcm:
607     tst     r0, #0x8000
608     bxne    lr
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
633 @ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@
634
635
636 .macro m_s68k_write16_2M_decode
637     ldr     r2, =(Pico+0x22200)
638     eor     r0, r0, #2
639     ldr     r2, [r2]
640     mov     r0, r0, lsr #1              @ +4-6 <<16
641     add     r2, r2, r3                  @ map to our address
642 .endm
643
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
652     bic     r1, r1, #0xf0
653     orr     r1, r1, r1, lsr #4
654     strb    r1, [r2, r0]
655     bx      lr
656
657 PicoWriteS68k16_dec_m1b0:               @ underwrite
658     mov     r3, #0x080000
659     b       0f
660
661 PicoWriteS68k16_dec_m1b1:
662     mov     r3, #0x0a0000
663 0:
664     bics    r1, r1, #0xf000
665     bicnes  r1, r1, #0x00f0
666     bxeq    lr
667     orr     r1, r1, r1, lsr #4
668     m_s68k_write16_2M_decode
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
678
679 PicoWriteS68k16_dec_m2b0:               @ overwrite
680     mov     r3, #0x080000
681     b       0f
682
683 PicoWriteS68k16_dec_m2b1:
684     mov     r3, #0x0a0000
685 0:
686     bics    r1, r1, #0xf000
687     bicnes  r1, r1, #0x00f0
688     bxeq    lr
689     orr     r1, r1, r1, lsr #4
690     m_s68k_write16_2M_decode
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
700
701
702 PicoWriteS68k16_pr:
703     and     r2, r0, #0xfe00
704     cmp     r2, #0x8000
705     bne     m_s68k_write8_pcm
706
707 m_s68k_write16_regs:
708     bic     r0, r0, #0xff0000
709     bic     r0, r0, #0x008000
710     bic     r0, r0, #1
711     tst     r0, #0x7e00
712     movne   r0, #0
713     bxne    lr
714     cmp     r0, #0x0e
715     beq     m_s68k_write16_regs_spec
716     sub     r2, r0, #0x58
717     cmp     r2, #0x10
718     blo     gfx_cd_write16
719     and     r3, r1, #0xff
720     add     r2, r0, #1
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
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;
733     bx      lr
734
735 .pool
736