notaz.gp2x.de / picodrive.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
platform ps2, handle audio similar to psp
[picodrive.git] / pico / draw_arm.S
CommitLineData
cff531af 1/*\r
2 * assembly optimized versions of most funtions from draw.c\r
ea38612f 3 * (C) notaz, 2006-2010,2017\r
7bf552b5 4 * (C) irixxxx, 2020-2024\r
cff531af 5 *\r
6 * This work is licensed under the terms of MAME license.\r
7 * See COPYING file in the top-level directory.\r
8 *\r
9 * this is highly specialized, be careful if changing related C code!\r
16b11d91 10 *\r
cdc6aac4 11 * NB only does RGB565 output, BGR isn't supported\r
cff531af 12 */\r
cc68a136 13\r
d40a5af4 14#include "pico_int_offs.h"\r
ea38612f 15\r
cc68a136 16.extern DrawStripInterlace\r
5a681086 17\r
47677a2a 18.equ PDRAW_WND_DIFF_PRIO, (1<<1)\r
283fec1b 19.equ PDRAW_PLANE_HI_PRIO, (1<<6)\r
20.equ PDRAW_SHHI_DONE, (1<<7)\r
17c1401b 21.equ PDRAW_BORDER_32, (1<<9)\r
52e4a905 22.equ PDRAW_32X_SCALE, (1<<12)\r
db1ee7a2 23.equ PDRAW_BGC_DMA, (1<<14)\r
17c1401b 24.equ PDRAW_SOFTSCALE, (1<<15)\r
cc68a136 25\r
cf07a88d 26@ helpers\r
27.macro add_c24 d s c\r
28 add \d, \s, #(\c & 0x00ff00)\r
29.if \c & 0x0000ff\r
30 add \d, \d, #(\c & 0x0000ff)\r
31.endif\r
32.if \c & 0xff0000\r
33 add \d, \d, #(\c & 0xff0000)\r
34.endif\r
35.endm\r
36\r
cc68a136 37.macro TilePixel pat lsrr offs\r
38.if !\lsrr\r
39 ands r4, \pat, r2\r
40.else\r
41 ands r4, \pat, r2, lsr #\lsrr\r
42.endif\r
43 orrne r4, r3, r4\r
44 strneb r4, [r1,#\offs]\r
45.endm\r
46\r
47@ TileNorm (r1=pdest, r2=pixels8, r3=pal) r4: scratch, pat: register with helper pattern 0xf\r
48.macro TileNorm pat\r
49 TilePixel \pat, 12, 0 @ #0x0000f000\r
50 TilePixel \pat, 8, 1 @ #0x00000f00\r
51 TilePixel \pat, 4, 2 @ #0x000000f0\r
52 TilePixel \pat, 0, 3 @ #0x0000000f\r
53 TilePixel \pat, 28, 4 @ #0xf0000000\r
54 TilePixel \pat, 24, 5 @ #0x0f000000\r
55 TilePixel \pat, 20, 6 @ #0x00f00000\r
56 TilePixel \pat, 16, 7 @ #0x000f0000\r
57.endm\r
58\r
59@ TileFlip (r1=pdest, r2=pixels8, r3=pal) r4: scratch, pat: register with helper pattern 0xf\r
60.macro TileFlip pat\r
61 TilePixel \pat, 16, 0 @ #0x000f0000\r
62 TilePixel \pat, 20, 1 @ #0x00f00000\r
63 TilePixel \pat, 24, 2 @ #0x0f000000\r
64 TilePixel \pat, 28, 3 @ #0xf0000000\r
65 TilePixel \pat, 0, 4 @ #0x0000000f\r
66 TilePixel \pat, 4, 5 @ #0x000000f0\r
67 TilePixel \pat, 8, 6 @ #0x00000f00\r
68 TilePixel \pat, 12, 7 @ #0x0000f000\r
69.endm\r
70\r
71@ shadow/hilight mode\r
72\r
08bbe7f8 73@ \r
74.macro TilePixelNonSH pat lsrr offs\r
75.if !\lsrr\r
76 ands r4, \pat, r2\r
77.else\r
78 ands r4, \pat, r2, lsr #\lsrr\r
79.endif\r
80 beq 0f\r
81 cmp r4, #0xe\r
82 orr r4, r3, r4\r
110a49ed 83 biceq r4, r4, #0x80\r
08bbe7f8 84 strb r4, [r1,#\offs]\r
850:\r
86.endm\r
87\r
88@ TileNormNonSH (r1=pdest, r2=pixels8, r3=pal) r4: scratch, pat: register with helper pattern 0xf\r
89.macro TileNormNonSH pat\r
90 TilePixelNonSH \pat, 12, 0 @ #0x0000f000\r
91 TilePixelNonSH \pat, 8, 1 @ #0x00000f00\r
92 TilePixelNonSH \pat, 4, 2 @ #0x000000f0\r
93 TilePixelNonSH \pat, 0, 3 @ #0x0000000f\r
94 TilePixelNonSH \pat, 28, 4 @ #0xf0000000\r
95 TilePixelNonSH \pat, 24, 5 @ #0x0f000000\r
96 TilePixelNonSH \pat, 20, 6 @ #0x00f00000\r
97 TilePixelNonSH \pat, 16, 7 @ #0x000f0000\r
98.endm\r
99\r
100@ TileFlipNonSH (r1=pdest, r2=pixels8, r3=pal) r4: scratch, pat: register with helper pattern 0xf\r
101.macro TileFlipNonSH pat\r
102 TilePixelNonSH \pat, 16, 0 @ #0x000f0000\r
103 TilePixelNonSH \pat, 20, 1 @ #0x00f00000\r
104 TilePixelNonSH \pat, 24, 2 @ #0x0f000000\r
105 TilePixelNonSH \pat, 28, 3 @ #0xf0000000\r
106 TilePixelNonSH \pat, 0, 4 @ #0x0000000f\r
107 TilePixelNonSH \pat, 4, 5 @ #0x000000f0\r
108 TilePixelNonSH \pat, 8, 6 @ #0x00000f00\r
109 TilePixelNonSH \pat, 12, 7 @ #0x0000f000\r
110.endm\r
111\r
cc68a136 112@ this one is for hi priority layer\r
113.macro TilePixelShHP lsrr offs\r
114.if !\lsrr\r
115 ands r4, r12, r2\r
116.else\r
117 ands r4, r12, r2, lsr #\lsrr\r
118.endif\r
119 ldreqb r4, [r1,#\offs]\r
120 orrne r4, r3, r4\r
6bfa97ff 121 andeq r4, r4, #0x7f\r
07abbab1 122 strb r4, [r1,#\offs]\r
cc68a136 123.endm\r
124\r
7a7c6476 125@ TileNormShHP (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: register with helper pattern 0xf, touches r3 high bits\r
cc68a136 126.macro TileNormShHP\r
127 TilePixelShHP 12, 0 @ #0x0000f000\r
128 TilePixelShHP 8, 1 @ #0x00000f00\r
129 TilePixelShHP 4, 2 @ #0x000000f0\r
130 TilePixelShHP 0, 3 @ #0x0000000f\r
131 TilePixelShHP 28, 4 @ #0xf0000000\r
132 TilePixelShHP 24, 5 @ #0x0f000000\r
133 TilePixelShHP 20, 6 @ #0x00f00000\r
134 TilePixelShHP 16, 7 @ #0x000f0000\r
135.endm\r
136\r
7a7c6476 137@ TileFlipShHP (r1=pdest, r2=pixels8, r3=pal) r4: scratch, pat: register with helper pattern 0xf\r
cc68a136 138.macro TileFlipShHP\r
139 TilePixelShHP 16, 0 @ #0x000f0000\r
140 TilePixelShHP 20, 1 @ #0x00f00000\r
141 TilePixelShHP 24, 2 @ #0x0f000000\r
142 TilePixelShHP 28, 3 @ #0xf0000000\r
143 TilePixelShHP 0, 4 @ #0x0000000f\r
144 TilePixelShHP 4, 5 @ #0x000000f0\r
145 TilePixelShHP 8, 6 @ #0x00000f00\r
146 TilePixelShHP 12, 7 @ #0x0000f000\r
147.endm\r
148\r
149\r
150@ TileSingleSh (r1=pdest, r2=pixels8, r3=pal) r4,r7: scratch, r0=sx; r12: helper pattern 0xf\r
151.macro TileSingleSh\r
152 tst r0, #1 @ not aligned?\r
6bfa97ff 153 mov r7, #0x008000\r
154 orr r7, r7, #0x80\r
155 ldrneb r4, [r1], #1\r
156 ldreqh r4, [r1], #2 @ 1ci\r
157 ldrh r12, [r1], #2\r
158 orr r4, r4, r7\r
159 strneb r4, [r1, #-3]\r
160 streqh r4, [r1, #-4]\r
161 ldrh r4, [r1], #2\r
162 orr r12, r12, r7\r
163 strh r12, [r1, #-4]\r
164 ldrh r12, [r1], #2\r
165 orr r4, r4, r7\r
166 strh r4, [r1, #-4]\r
167 ldrneb r4, [r1]\r
168 orr r12, r12, r7\r
169 strh r12, [r1, #-2]\r
170 orrne r4, r4, r7\r
171 strneb r4, [r1], #1\r
172 mov r12, #0xf\r
cc68a136 173.endm\r
174\r
175@ TileSingleHi (r1=pdest, r2=pixels8, r3=pal) r4,r7: scratch, r0=sx, r12: register with helper pattern 0xf\r
176.macro TileSingleHi\r
177 tst r1, #1 @ not aligned?\r
6bfa97ff 178 mov r7, #0x004000\r
179 orr r7, r7, #0x40\r
cc68a136 180 ldrneb r4, [r1], #1\r
181 ldreqh r4, [r1], #2 @ 1ci\r
182 ldrh r12, [r1], #2\r
cc68a136 183 orr r4, r4, r7\r
184 strneb r4, [r1, #-3]\r
185 streqh r4, [r1, #-4]\r
186 ldrh r4, [r1], #2\r
cc68a136 187 orr r12, r12, r7\r
188 strh r12, [r1, #-4]\r
189 ldrh r12, [r1], #2\r
cc68a136 190 orr r4, r4, r7\r
191 strh r4, [r1, #-4]\r
192 ldrneb r4, [r1]\r
cc68a136 193 orr r12, r12, r7\r
194 strh r12, [r1, #-2]\r
cc68a136 195 orrne r4, r4, r7\r
196 strneb r4, [r1], #1\r
197 mov r12, #0xf\r
198.endm\r
199\r
200.macro TileDoShGenPixel shift ofs\r
201.if \shift\r
202 ands r4, r12, r2, lsr #\shift\r
203.else\r
204 ands r4, r12, r2\r
205.endif\r
07abbab1 206 beq 0f\r
cc68a136 207 cmp r4, #0xe\r
bfa12428 208 ldrgeb r7, [r1,#\ofs]\r
209 orrlt r7, r3, r4 @ normal\r
07abbab1 210\r
6bfa97ff 211 subge r4, r4, #1\r
bfa12428 212 orrge r7, r7, r4, lsl #6\r
213 strb r7, [r1,#\ofs]\r
07abbab1 2140:\r
cc68a136 215.endm\r
216\r
217@ TileFlipSh (r1=pdest, r2=pixels8, r3=pal) r4,r7: scratch, r0=sx, r12: register with helper pattern 0xf\r
218.macro TileFlipSh\r
219 TileDoShGenPixel 16, 0 @ #0x000f0000\r
220 TileDoShGenPixel 20, 1 @ #0x00f00000\r
221 TileDoShGenPixel 24, 2 @ #0x0f000000\r
222 TileDoShGenPixel 28, 3 @ #0xf0000000\r
223 TileDoShGenPixel 0, 4 @ #0x0000000f\r
224 TileDoShGenPixel 4, 5 @ #0x000000f0\r
225 TileDoShGenPixel 8, 6 @ #0x00000f00\r
226 TileDoShGenPixel 12, 7 @ #0x0000f000\r
227.endm\r
228\r
229@ TileNormSh (r1=pdest, r2=pixels8, r3=pal) r4,r7: scratch, r0=sx, r12: register with helper pattern 0xf\r
230.macro TileNormSh\r
231 TileDoShGenPixel 12, 0 @ #0x0000f000\r
232 TileDoShGenPixel 8, 1 @ #0x00000f00\r
233 TileDoShGenPixel 4, 2 @ #0x000000f0\r
234 TileDoShGenPixel 0, 3 @ #0x0000000f\r
235 TileDoShGenPixel 28, 4 @ #0xf0000000\r
236 TileDoShGenPixel 24, 5 @ #0x0f000000\r
237 TileDoShGenPixel 20, 6 @ #0x00f00000\r
238 TileDoShGenPixel 16, 7 @ #0x000f0000\r
239.endm\r
240\r
bfa12428 241.macro TileDoShGenPixel_markop shift ofs\r
07abbab1 242.if \shift\r
bfa12428 243 ands r4, r12, r2, lsr #\shift\r
07abbab1 244.else\r
bfa12428 245 ands r4, r12, r2\r
07abbab1 246.endif\r
bfa12428 247 beq 0f\r
248 cmp r4, #0xe\r
249 ldrgeb r4, [r1,#\ofs]\r
250 orrlt r4, r3, r4\r
6bfa97ff 251 orrge r4, r4, #0x40\r
bfa12428 252 strb r4, [r1,#\ofs]\r
2530:\r
07abbab1 254.endm\r
255\r
e54507e8 256.macro TileFlipSh_markop\r
bfa12428 257 TileDoShGenPixel_markop 16, 0 @ #0x000f0000\r
258 TileDoShGenPixel_markop 20, 1 @ #0x00f00000\r
259 TileDoShGenPixel_markop 24, 2 @ #0x0f000000\r
260 TileDoShGenPixel_markop 28, 3 @ #0xf0000000\r
261 TileDoShGenPixel_markop 0, 4 @ #0x0000000f\r
262 TileDoShGenPixel_markop 4, 5 @ #0x000000f0\r
263 TileDoShGenPixel_markop 8, 6 @ #0x00000f00\r
264 TileDoShGenPixel_markop 12, 7 @ #0x0000f000\r
07abbab1 265.endm\r
266\r
e54507e8 267.macro TileNormSh_markop\r
bfa12428 268 TileDoShGenPixel_markop 12, 0 @ #0x0000f000\r
269 TileDoShGenPixel_markop 8, 1 @ #0x00000f00\r
270 TileDoShGenPixel_markop 4, 2 @ #0x000000f0\r
271 TileDoShGenPixel_markop 0, 3 @ #0x0000000f\r
272 TileDoShGenPixel_markop 28, 4 @ #0xf0000000\r
273 TileDoShGenPixel_markop 24, 5 @ #0x0f000000\r
274 TileDoShGenPixel_markop 20, 6 @ #0x00f00000\r
275 TileDoShGenPixel_markop 16, 7 @ #0x000f0000\r
07abbab1 276.endm\r
277\r
278.macro TileDoShGenPixel_onlyop_lp shift ofs\r
279.if \shift\r
280 ands r7, r12, r2, lsr #\shift\r
281.else\r
282 ands r7, r12, r2\r
283.endif\r
284 ldrneb r4, [r1,#\ofs]\r
07abbab1 285 cmp r7, #0xe\r
bfa12428 286 blt 0f\r
287\r
6bfa97ff 288 tst r4, #0x40\r
289 bicne r4, r4, #0x40\r
290 subne r7, r7, #1\r
bfa12428 291 orrne r4, r4, r7, lsl #6\r
292 strneb r4, [r1,#\ofs]\r
07abbab1 2930:\r
294.endm\r
295\r
296.macro TileFlipSh_onlyop_lp\r
297 TileDoShGenPixel_onlyop_lp 16, 0 @ #0x000f0000\r
298 TileDoShGenPixel_onlyop_lp 20, 1 @ #0x00f00000\r
299 TileDoShGenPixel_onlyop_lp 24, 2 @ #0x0f000000\r
300 TileDoShGenPixel_onlyop_lp 28, 3 @ #0xf0000000\r
301 TileDoShGenPixel_onlyop_lp 0, 4 @ #0x0000000f\r
302 TileDoShGenPixel_onlyop_lp 4, 5 @ #0x000000f0\r
303 TileDoShGenPixel_onlyop_lp 8, 6 @ #0x00000f00\r
304 TileDoShGenPixel_onlyop_lp 12, 7 @ #0x0000f000\r
305.endm\r
306\r
307.macro TileNormSh_onlyop_lp\r
308 TileDoShGenPixel_onlyop_lp 12, 0 @ #0x0000f000\r
309 TileDoShGenPixel_onlyop_lp 8, 1 @ #0x00000f00\r
310 TileDoShGenPixel_onlyop_lp 4, 2 @ #0x000000f0\r
311 TileDoShGenPixel_onlyop_lp 0, 3 @ #0x0000000f\r
312 TileDoShGenPixel_onlyop_lp 28, 4 @ #0xf0000000\r
313 TileDoShGenPixel_onlyop_lp 24, 5 @ #0x0f000000\r
314 TileDoShGenPixel_onlyop_lp 20, 6 @ #0x00f00000\r
315 TileDoShGenPixel_onlyop_lp 16, 7 @ #0x000f0000\r
316.endm\r
317\r
cc68a136 318\r
319@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
320\r
321@ struct TileStrip\r
322@ {\r
323@ int nametab; // 0x00\r
324@ int line; // 0x04\r
325@ int hscroll; // 0x08\r
326@ int xmask; // 0x0C\r
327@ int *hc; // 0x10 (pointer to cache buffer)\r
328@ int cells; // 0x14\r
329@ };\r
330\r
e0bcb7a9 331@ void DrawLayer(int lflags, int *hcache, int cellskip, int maxcells,\r
ea38612f 332@ struct PicoEState *est)\r
cc68a136 333\r
83c093a4 334.global DrawLayer\r
cc68a136 335\r
336DrawLayer:\r
ea38612f 337 ldr r12, [sp] @ est\r
cc68a136 338 stmfd sp!, {r4-r11,lr}\r
339\r
88fd63ad 340 ldr r11, [r12, #OFS_EST_Pico]\r
cc68a136 341 mov r8, #1\r
342\r
88fd63ad 343 ldrb r7, [r11, #OFS_Pico_video_reg+16] @ ??vv??hh\r
cc68a136 344\r
345 mov r6, r1 @ hcache\r
e0bcb7a9 346 orr r9, r3, r0, lsl #29 @ r9=force[31]|sh[30]|plane[29]\r
347 orr r9, r9, r2, lsl #8 @ |cellskip[15:8]|maxcells[7:0] (tmp)\r
cc68a136 348\r
349 mov r1, r7, lsl #4\r
350 orr r1, r1, #0x00ff\r
351\r
352 and r10, r7, #3\r
353 cmp r10, #1\r
354 biclt r1, r1, #0xfc00\r
355 biceq r1, r1, #0xfe00\r
eced0190 356 cmp r10, #2\r
357 moveq r1, #0x0007\r
358 movgt r1, #0x00ff @ r1=ymask=(height<<8)|0xff; ...; // Y Mask in pixels\r
cc68a136 359\r
93f41f8e 360 cmp r10, #2\r
361 addlt r10, r10, #5\r
362 moveq r10, #5\r
363 movgt r10, #7 @ r10=shift[width] (5,6,5,7)\r
cc68a136 364\r
88fd63ad 365 ldr r2, [r12, #OFS_EST_DrawScanline]\r
366 ldr lr, [r12, #OFS_EST_PicoMem_vram]\r
cc68a136 367\r
368 @ Find name table:\r
83c093a4 369 ands r0, r0, #1\r
88fd63ad 370 ldreqb r12, [r11, #OFS_Pico_video_reg+2]\r
371 ldrneb r12, [r11, #OFS_Pico_video_reg+4]\r
cc68a136 372\r
ea38612f 373 @ calculate xmask:\r
374 mov r5, r8, lsl r10\r
375 sub r5, r5, #1 @ r5=xmask\r
cc68a136 376\r
377 moveq r12, r12, lsl #10\r
378 movne r12, r12, lsl #13\r
379 and r12, r12, #(7<<13) @ r12=(ts->nametab<<1) (halfword compliant)\r
380\r
88fd63ad 381 ldrh r8, [r11, #OFS_Pico_video_reg+12]\r
382 ldrb r7, [r11, #OFS_Pico_video_reg+11]\r
cc68a136 383\r
384 mov r4, r8, lsr #8 @ pvid->reg[13]\r
385 mov r4, r4, lsl #10 @ htab=pvid->reg[13]<<9; (halfwords)\r
29d99d6b 386\r
387 ands r3, r7, #0x03\r
388 beq 0f\r
389 cmp r3, #2\r
390 mov r3, r2, lsl #2 @ htab+=DrawScanline<<1; // Offset by line\r
110a49ed 391 biceq r3, r3, #0x1f @ htab&=~0xf; // Offset by tile\r
392 andlt r3, r3, #0x1f\r
29d99d6b 393 add r4, r4, r3\r
3940: add r4, r4, r0, lsl #1 @ htab+=plane\r
cc68a136 395 bic r4, r4, #0x00ff0000 @ just in case\r
396 ldrh r3, [lr, r4] @ r3=hscroll\r
397\r
398 tst r7, #4\r
399 bne .DrawStrip_vsscroll\r
400\r
401 @ Get vertical scroll value:\r
cf07a88d 402 add_c24 r7, lr, (OFS_PMEM_vsram-OFS_PMEM_vram)\r
cc68a136 403 ldr r7, [r7]\r
404\r
405 tst r8, #2\r
406 tstne r8, #4\r
407 bne .DrawStrip_interlace\r
408\r
409 tst r0, r0\r
93f41f8e 410 moveq r7, r7, lsl #16\r
411 mov r7, r7, lsr #16\r
cc68a136 412\r
413 @ Find the line in the name table\r
414 add r2, r2, r7\r
415 and r2, r2, r1\r
416 mov r4, r2, lsr #3\r
417 add r10, r10, #1 @ shift[width]++\r
418 add r12, r12, r4, lsl r10 @ nametab+=(ts.line>>3)<<shift[width];\r
419\r
420 @ ldmia r0, {r1,r2,r3,r5,r6,r9} @ r2=line, r3=ts->hscroll, r5=ts->xmask, r6=ts->hc, r9=ts->cells\r
cc68a136 421\r
422 and r10,r2, #7\r
423 mov r10,r10, lsl #1 @ r10=ty=(ts->line&7)<<1;\r
424 orr r10,r10, r9, lsl #24\r
425\r
426 rsb r8, r3, #0\r
427 mov r8, r8, lsr #3 @ r8=tilex=(-ts->hscroll)>>3\r
428\r
429 sub r1, r3, #1\r
430 and r1, r1, #7\r
431 add r7, r1, #1 @ r7=dx=((ts->hscroll-1)&7)+1\r
432\r
e0bcb7a9 433 movs r3, r9, lsl #1 @ (force[31]|sh[30]) << 1\r
cc68a136 434 mov r3, #0\r
e0bcb7a9 435 orrmi r10,r10, #1<<23 @ r10=cells[31:24]|sh[23]|hi_not_empty[22]\r
11a1966b 436@ orrcc r10,r10, #1<<20 @ |had_output[21]|!force[20]|hscroll[18:16]|ty[15:0]\r
6bfa97ff 437 movmi r3, #0x80 @ default to shadowed pal on sh mode\r
cc68a136 438\r
1fad746a 439 and r4, r7, #7\r
440 orr r10,r10, r4, lsl #16 @ we will process cells+1 if there is scroll\r
cc68a136 441\r
83c093a4 442 and r9, r9, #0xff00\r
443 add r8, r8, r9, lsr #8 @ tilex+=cellskip\r
444 add r7, r7, r9, lsr #5 @ dx+=cellskip<<3;\r
445 sub r10,r10,r9, lsl #16 @ cells-=cellskip\r
83c093a4 446\r
cc68a136 447 @ cache some stuff to avoid mem access\r
99bdfd31 448 ldr r11,[sp, #9*4] @ est\r
cc68a136 449 mov r0, #0xf\r
88fd63ad 450 ldr r11,[r11, #OFS_EST_HighCol]\r
ea8c405f 451\r
452 mvn r9, #0 @ r9=prevcode=-1\r
99bdfd31 453 add r1, r11, r7 @ r1=pdest\r
cc68a136 454\r
11a1966b 455 @ r10=cells[31:24]|sh[23]|hi_not_empty[22]|had_output[21]|!force[20]|hscroll[18:16]|ty[15:0]\r
71a2e205 456 @ r1=pd+dx r2=pack r3=pal r5=xmask r6=hc r8=tilex r9=prevcode r11=HighCol r12=nametab lr=vram\r
cc68a136 457 @ r4 & r7 are scratch in this loop\r
1fad746a 458\r
459 ands r4, r10, #7<<16 @ hscroll?\r
460 beq .dsloop_subr1\r
461 subs r10,r10, #0x01000000\r
462 bmi .dsloop_exit\r
463\r
464 and r7, r5, r8 @ do first cut tile\r
465 add r7, lr, r7, lsl #1 @ Pico.vram+((tilex&ts->xmask) as halfwords)\r
466 ldrh r9, [r7, r12] @ r7=code (int, but from unsigned, no sign extend)\r
467\r
468 add r8, r8, #1\r
469\r
11a1966b 470 tst r9, #0x1000 @ if (code&0x1000)\r
471 mov r2, r9, lsl #21\r
1fad746a 472 add r2, r2, r10, lsl #17\r
11a1966b 473 eorne r2, r2, #0xe<<17 @ if (code&0x1000) addr^=0xe;\r
1fad746a 474\r
11a1966b 475 ldr r2, [lr, r2, lsr #16] @ pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
1fad746a 476\r
477 mvn r7, #0\r
478 mov r4, r4, lsr #16-2 @ (dx&7)*4\r
479 tst r9, #0x0800\r
480 moveq r7, r7, lsl r4 @ mask = ~0 [shift] (dx&7)*4\r
481 movne r7, r7, lsr r4\r
11a1966b 482 bic r2, r2, r7, ror #16 @ pack&~mask\r
1fad746a 483\r
484 orr r9, r9, #0x80000000 @ invalidate oldcode since pack is masked\r
485 b .DrawStrip_samecode\r
486\r
cc68a136 487.dsloop_subr1:\r
488 sub r1, r1, #8\r
489.dsloop: @ 40-41 times\r
490 subs r10,r10, #0x01000000\r
491 bmi .dsloop_exit\r
492\r
cc68a136 493 and r7, r5, r8\r
494 add r7, lr, r7, lsl #1 @ Pico.vram+((tilex&ts->xmask) as halfwords)\r
495 ldrh r7, [r7, r12] @ r7=code (int, but from unsigned, no sign extend)\r
496\r
497 add r1, r1, #8\r
498 add r8, r8, #1\r
499\r
cc68a136 500 cmp r7, r9\r
501 beq .DrawStrip_samecode @ we know stuff about this tile already\r
502\r
503 mov r9, r7 @ remember code\r
504\r
11a1966b 505 tst r9, #0x1000 @ if (code&0x1000)\r
506 mov r2, r9, lsl #21\r
cc68a136 507 add r2, r2, r10, lsl #17\r
11a1966b 508 eorne r2, r2, #0x0e<<17 @ if (code&0x1000) addr^=0xe;\r
cc68a136 509\r
11a1966b 510 ldr r2, [lr, r2, lsr #16] @ pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
cc68a136 511.DrawStrip_samecode:\r
47677a2a 512 tst r9, #0x8000\r
71a2e205 513@ tstne r10, #1<<20 @ !force[20]\r
47677a2a 514 bne .DrawStrip_hiprio\r
515\r
516 orr r10, r10, #1<<21 @ seen non hi-prio tile\r
cc68a136 517 tst r2, r2\r
518 beq .dsloop @ tileline blank\r
519\r
47677a2a 520 bic r7, r3, #0x7f\r
521 and r3, r9, #0x6000\r
522 add r3, r7, r3, lsr #9 @ r3=pal=((code&0x6000)>>9);\r
523\r
cc68a136 524 cmp r2, r2, ror #4\r
525 beq .DrawStrip_SingleColor @ tileline singlecolor \r
526\r
527 tst r9, #0x0800\r
7a7c6476 528 bne .DrawStrip_TileFlip\r
cc68a136 529\r
530 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r0: helper pattern\r
cc68a136 531.DrawStrip_TileNorm:\r
532 TileNorm r0\r
533 b .dsloop\r
534\r
7a7c6476 535.DrawStrip_TileFlip:\r
536 TileFlip r0\r
537 b .dsloop\r
538\r
cc68a136 539.DrawStrip_SingleColor:\r
540 and r4, r2, #0xf\r
541 orr r4, r3, r4\r
542 orr r4, r4, r4, lsl #8\r
543 tst r1, #1 @ not aligned?\r
544 strneb r4, [r1], #1\r
545 streqh r4, [r1], #2\r
546 strh r4, [r1], #2\r
547 strh r4, [r1], #2\r
548 strh r4, [r1], #2\r
549 strneb r4, [r1], #1 @ have a remaining unaligned pixel?\r
550 b .dsloop_subr1\r
551\r
740da8c6 552.DrawStrip_hiprio:\r
47677a2a 553 tst r10, #(1<<23) @ sh[23]\r
554 tsteq r2, r2 @ if (!sh[23] && code==blank) continue\r
555 beq .dsloop\r
556\r
557@ orr r10, r10, #1<<22 @ hi_not_empty[22]\r
558 sub r7, r1, r11\r
559 orr r7, r9, r7, lsl #16\r
740da8c6 560 orr r7, r7, r10, lsl #25 @ (ty<<25)\r
47677a2a 561 tst r9, #0x1000\r
562 eorne r7, r7, #0xe<<25 @ if(code&0x1000) cval^=0xe<<25;\r
563 str r7, [r6], #4 @ cache hi priority tile code\r
564 str r2, [r6], #4 @ cache hi priority tile data\r
cc68a136 565 b .dsloop\r
566\r
567.dsloop_exit:\r
1fad746a 568 ands r4,r10, #7<<16 @ hscroll?\r
569 beq .DrawStrip_noscroll\r
570\r
571 and r7, r5, r8 @ do one more cut tile\r
572 add r7, lr, r7, lsl #1 @ Pico.vram+((tilex&ts->xmask) as halfwords)\r
573 ldrh r9, [r7, r12] @ r7=code (int, but from unsigned, no sign extend)\r
574\r
575 add r1, r1, #8\r
576\r
11a1966b 577 tst r9, #0x1000 @ if (code&0x1000)\r
578 mov r2, r9, lsl #21\r
1fad746a 579 add r2, r2, r10, lsl #17\r
11a1966b 580 eorne r2, r2, #0x0e<<17 @ if (code&0x1000) addr^=0xe;\r
1fad746a 581\r
11a1966b 582 ldr r2, [lr, r2, lsr #16] @ pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
1fad746a 583\r
584 mvn r7, #0\r
585 mov r4, r4, lsr #16-2 @ (dx&7)*4\r
586 tst r9, #0x0800\r
587 moveq r7, r7, lsl r4 @ mask = ~0 [shift] (dx&7)*4\r
588 movne r7, r7, lsr r4\r
11a1966b 589 and r2, r2, r7, ror #16 @ pack&mask\r
1fad746a 590\r
591 bic r10,r10, #7<<16\r
592 b .DrawStrip_samecode @ one last time, with last tile now masked\r
593\r
594.DrawStrip_noscroll:\r
740da8c6 595 tst r10, #1<<21 @ seen non hi-prio tile\r
ea38612f 596 ldr r1, [sp, #9*4] @ est\r
cc68a136 597 mov r0, #0\r
88fd63ad 598 ldreq r2, [r1, #OFS_EST_rendstatus]\r
cc68a136 599 str r0, [r6] @ terminate the cache list\r
283fec1b 600 orreq r2, r2, #PDRAW_PLANE_HI_PRIO @ had a layer with all hi-prio tiles\r
88fd63ad 601 streq r2, [r1, #OFS_EST_rendstatus]\r
cc68a136 602\r
47677a2a 603 ldmfd sp!, {r4-r11,pc}\r
cc68a136 604\r
6d7acf9e 605@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
cc68a136 606\r
607.DrawStrip_vsscroll:\r
61114cd8 608 tst r8, #1 @ if h40: lflags |= 0x10000\r
609 orrne r0, r0, #0x10000\r
610\r
6d7acf9e 611 rsb r8, r3, #0\r
612 mov r8, r8, lsr #3 @ r8=tilex=(-ts->hscroll)>>3\r
7b802576 613 bic r8, r8, #0x3fc00000\r
71a2e205 614 orr r8, r8, r5, lsl #25 @ r8=(xmask[31:25]|had_output[24]|!force[23]|tilex[21:0])\r
cc68a136 615\r
ea38612f 616 ldr r11, [sp, #9*4] @ est\r
6d7acf9e 617 orr r5, r1, r10, lsl #24\r
88fd63ad 618 ldr r4, [r11, #OFS_EST_DrawScanline]\r
6d7acf9e 619 sub r1, r3, #1\r
620 orr r5, r5, r4, lsl #16 @ r5=(shift_width[31:24]|scanline[23:16]|ymask[15:0])\r
621 and r1, r1, #7\r
622 add r7, r1, #1 @ r7=dx=((ts->hscroll-1)&7)+1\r
cc68a136 623\r
6d7acf9e 624 mov r10,r9, lsl #16\r
cf07a88d 625 orr r10,r10, #0xff000000 @ will be adjusted on entering loop\r
83c093a4 626 tst r0, #1\r
6d7acf9e 627 orrne r10,r10, #0x8000\r
cf07a88d 628 tst r3, #0x0f @ hscroll & 0x0f?\r
629 beq 0f\r
630 eor r3, r3, r7\r
631 sub r10,r10, #1<<24 @ cell-- // start from negative for hscroll\r
632 tst r3, #0x08\r
633 subne r10,r10, #1<<16 @ cells--\r
634 subne r10,r10, #1<<24 @ cell-- // even more negative\r
61114cd8 635\r
636 add_c24 r1, lr, (OFS_PMEM_vsram-OFS_PMEM_vram)\r
637 tst r0, #0x10000 @ h40?\r
638 ldrne r3, [r1, #0x00] @ r3=vsram[0x00..0x01]\r
639 ldreq r3, [r1, #0x40] @ r3=vsram[0x20..0x21]\r
6dd553c7 640 str r3, [r1, #0x7c] @ vsram[0x3e..0x3f]=r3\r
cf07a88d 6410:\r
6bfa97ff 642 tst r9, #1<<30\r
6d7acf9e 643 mov r3, #0\r
83c093a4 644 orrne r10,r10, #1<<23 @ r10=(cell[31:24]|sh[23]|hi_not_empty[22]|cells_max[21:16]|plane[15]|ty[14:0])\r
6bfa97ff 645 movne r3, #0x80 @ default to shadowed pal on sh mode\r
71a2e205 646@ tst r9, #1<<31\r
647@ orreq r8, r8, #1<<23\r
cc68a136 648\r
83c093a4 649 and r9, r9, #0xff00\r
650 add r8, r8, r9, lsr #8 @ tilex+=cellskip\r
651 add r7, r7, r9, lsr #5 @ dx+=cellskip<<3;\r
652 add r10,r10,r9, lsl #16 @ cell+=cellskip\r
cc68a136 653\r
6d7acf9e 654 @ cache some stuff to avoid mem access\r
99bdfd31 655 ldr r11,[sp, #9*4] @ est\r
ea8c405f 656 mov r0, #0xf\r
88fd63ad 657 ldr r11,[r11, #OFS_EST_HighCol]\r
6d7acf9e 658\r
ea8c405f 659 mvn r9, #0 @ r9=prevcode=-1\r
660 add r1, r11, r7 @ r1=pdest\r
6d7acf9e 661\r
71a2e205 662 @ r10=cells[31:24]|sh[23]|hi_not_empty[22]|cells_max[21:16]|plane[15]|ty[14:0]\r
663 @ r8=xmask[31:25]|had_output[24]|!force[23]|tilex[21:0]\r
664 @ r5=shift_width[31:24]|scanline[23:16]|ymask[15:0]\r
665 @ r3=nametabadd[31:16]|must_be_0[15:8]|pal[7:0]\r
666 @ r1=pd+dx r2=pack r6=hc r9=prevcode r11=HighCol r12=nametab lr=vram\r
6d7acf9e 667 @ r4 & r7 are scratch in this loop\r
33cb1ab0 668\r
669 @ need to calc new ty?\r
110a49ed 670 movs r7, r10, lsl #7 @ (cell&1)?\r
33cb1ab0 671 bmi .dsloop_vs_subr1\r
672\r
673 @ calc offset and read tileline code to r7, also calc ty\r
674 add_c24 r7, lr, (OFS_PMEM_vsram-OFS_PMEM_vram)\r
675 and r4, r10, #0x3e000000\r
676 add r7, r7, r4, asr #23 @ vsram + ((cell&0x3e)<<1)\r
677 tst r10,#0x8000 @ plane1?\r
678 addne r7, r7, #2\r
679 ldrh r7, [r7] @ r7=vscroll\r
680\r
681 bic r10,r10,#0xff @ clear old ty\r
682 and r4, r5, #0xff0000 @ scanline\r
683 add r4, r4, r7, lsl #16 @ ... += vscroll\r
684 and r4, r4, r5, lsl #16 @ ... &= ymask\r
685 and r7, r4, #0x70000\r
686 orr r10,r10,r7, lsr #15 @ new ty\r
687\r
688 mov r4, r4, lsr #19\r
689 mov r7, r5, lsr #24\r
690 mov r4, r4, lsl r7 @ nametabadd\r
691 and r3, r3, #0xff\r
692 orr r3, r3, r4, lsl #16 @ r3=(nametabadd[31:16],pal[15:0])\r
693\r
6d7acf9e 694.dsloop_vs_subr1:\r
695 sub r1, r1, #8\r
696.dsloop_vs: @ 40-41 times\r
697 add r10,r10, #0x01000000\r
698 and r4, r10, #0x003f0000\r
699 cmp r4, r10, asr #8\r
740da8c6 700 ble .dsloop_vs_exit\r
6d7acf9e 701\r
71a2e205 702 @ need to calc new ty?\r
110a49ed 703 movs r7, r10, lsl #7 @ (cell&1)?\r
71a2e205 704 bmi 0f\r
705\r
6d7acf9e 706 @ calc offset and read tileline code to r7, also calc ty\r
cf07a88d 707 add_c24 r7, lr, (OFS_PMEM_vsram-OFS_PMEM_vram)\r
6dd553c7 708 and r4, r10, #0x3e000000\r
709 add r7, r7, r4, asr #23 @ vsram + ((cell&0x3e)<<1)\r
6d7acf9e 710 tst r10,#0x8000 @ plane1?\r
711 addne r7, r7, #2\r
712 ldrh r7, [r7] @ r7=vscroll\r
713\r
714 bic r10,r10,#0xff @ clear old ty\r
7b802576 715 and r4, r5, #0xff0000 @ scanline\r
716 add r4, r4, r7, lsl #16 @ ... += vscroll\r
717 and r4, r4, r5, lsl #16 @ ... &= ymask\r
6d7acf9e 718 and r7, r4, #0x70000\r
719 orr r10,r10,r7, lsr #15 @ new ty\r
720\r
721 mov r4, r4, lsr #19\r
722 mov r7, r5, lsr #24\r
723 mov r4, r4, lsl r7 @ nametabadd\r
71a2e205 724 and r3, r3, #0xff\r
725 orr r3, r3, r4, lsl #16 @ r3=(nametabadd[31:16],pal[15:0])\r
7260:\r
6d7acf9e 727 and r7, r8, r8, lsr #25\r
88fd63ad 728 add r7, lr, r7, lsl #1 @ PicoMem.vram+((tilex&ts->xmask) as halfwords)\r
71a2e205 729 add r7, r7, r3, lsr #15\r
6d7acf9e 730 ldrh r7, [r7, r12] @ r7=code (int, but from unsigned, no sign extend)\r
731\r
732 add r1, r1, #8\r
733 add r8, r8, #1\r
734\r
29d99d6b 735 orr r7, r7, r10, lsl #24 @ code | (ty << 24)\r
6d7acf9e 736 cmp r7, r9\r
737 beq .DrawStrip_vs_samecode @ we know stuff about this tile already\r
738\r
739 mov r9, r7 @ remember code\r
740\r
11a1966b 741 tst r9, #0x1000 @ if (code&0x1000)\r
742 mov r2, r9, lsl #21\r
6d7acf9e 743 add r2, r2, r10, lsl #17\r
11a1966b 744 eorne r2, r2, #0x0e<<17 @ if (code&0x1000) addr^=0xe;\r
6d7acf9e 745\r
11a1966b 746 ldr r2, [lr, r2, lsr #16] @ pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
6d7acf9e 747\r
6d7acf9e 748.DrawStrip_vs_samecode:\r
47677a2a 749 tst r9, #0x8000\r
71a2e205 750@ tstne r8, #1<<23 @ !force[23]\r
47677a2a 751 bne .DrawStrip_vs_hiprio\r
752\r
753 orr r8, r8, #(1<<24)@ seen non hi-prio tile\r
6d7acf9e 754 tst r2, r2\r
755 beq .dsloop_vs @ tileline blank\r
756\r
47677a2a 757 bic r7, r3, #0x7f\r
758 and r3, r9, #0x6000\r
759 add r3, r7, r3, lsr #9 @ r3=pal=((code&0x6000)>>9);\r
760\r
6d7acf9e 761 cmp r2, r2, ror #4\r
762 beq .DrawStrip_vs_SingleColor @ tileline singlecolor \r
763\r
764 tst r9, #0x0800\r
7a7c6476 765 bne .DrawStrip_vs_TileFlip\r
6d7acf9e 766\r
767 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r0: helper pattern\r
6d7acf9e 768.DrawStrip_vs_TileNorm:\r
769 TileNorm r0\r
770 b .dsloop_vs\r
771\r
7a7c6476 772.DrawStrip_vs_TileFlip:\r
773 TileFlip r0\r
774 b .dsloop_vs\r
775\r
6d7acf9e 776.DrawStrip_vs_SingleColor:\r
777 and r4, r2, #0xf\r
778 orr r4, r3, r4\r
779 orr r4, r4, r4, lsl #8\r
780 tst r1, #1 @ not aligned?\r
781 strneb r4, [r1], #1\r
782 streqh r4, [r1], #2\r
783 strh r4, [r1], #2\r
784 strh r4, [r1], #2\r
785 strh r4, [r1], #2\r
786 strneb r4, [r1], #1 @ have a remaining unaligned pixel?\r
787 b .dsloop_vs_subr1\r
788\r
789.DrawStrip_vs_hiprio:\r
47677a2a 790 tst r10, #(1<<23) @ sh[23]\r
791 tsteq r2, r2 @ if (!sh[23] && code==blank) continue\r
792 beq .dsloop_vs\r
793\r
794@ orr r10, r10, #1<<22 @ hi_not_empty[22]\r
795 sub r7, r1, r11\r
796 orr r7, r9, r7, lsl #16\r
6d7acf9e 797 orr r7, r7, r10, lsl #25 @ (ty<<25)\r
47677a2a 798 tst r9, #0x1000\r
6d7acf9e 799 eorne r7, r7, #7<<26 @ if(code&0x1000) cval^=7<<26;\r
47677a2a 800 str r7, [r6], #4 @ cache hi priority tile code\r
801 str r2, [r6], #4 @ cache hi priority tile data\r
6d7acf9e 802 b .dsloop_vs\r
803\r
740da8c6 804.dsloop_vs_exit:\r
7b802576 805 tst r8, #(1<<24) @ seen non hi-prio tile\r
ea38612f 806 ldr r1, [sp, #9*4] @ est\r
740da8c6 807 mov r0, #0\r
88fd63ad 808 ldreq r2, [r1, #OFS_EST_rendstatus]\r
740da8c6 809 str r0, [r6] @ terminate the cache list\r
283fec1b 810 orreq r2, r2, #PDRAW_PLANE_HI_PRIO @ had a layer with all hi-prio tiles\r
88fd63ad 811 streq r2, [r1, #OFS_EST_rendstatus]\r
740da8c6 812\r
47677a2a 813 ldmfd sp!, {r4-r11,pc}\r
740da8c6 814\r
6d7acf9e 815\r
816@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
cc68a136 817\r
818@ interlace mode 2? Sonic 2?\r
819.DrawStrip_interlace:\r
820 tst r0, r0\r
93f41f8e 821 movne r7, r7, lsr #16\r
822 mov r7, r7, lsl #21\r
cc68a136 823\r
824 @ Find the line in the name table\r
b6d7ac70 825 add r2, r7, r2, lsl #22 @ r2=(vscroll+(DrawScanline<<1))<<21 (11 bits);\r
cc68a136 826 orr r1, r1, #0x80000000\r
827 and r2, r2, r1, ror #10 @ &((ymask<<1)|1)<<21;\r
828 mov r2, r2, lsr #21\r
829 mov r4, r2, lsr #4\r
830 mov r12, r12, lsr #1 @ halfwords\r
831 add r0, r12, r4, lsl r10 @ nametab+=(ts.line>>4)<<shift[width];\r
832 and r9, r9, #0xff\r
833\r
834 sub sp, sp, #6*4\r
835 stmia sp, {r0,r2,r3,r5,r6,r9}\r
836\r
837 mov r0, sp\r
6bfa97ff 838 mov r1, r9, lsr #29\r
839 bl DrawStripInterlace @ struct TileStrip *ts, int plane_sh\r
cc68a136 840\r
841 add sp, sp, #6*4\r
47677a2a 842 ldmfd sp!, {r4-r11,pc}\r
cc68a136 843\r
844.pool\r
845\r
846@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
847\r
99bdfd31 848@ void BackFill(int reg7, int sh, struct PicoEState *est)\r
cc68a136 849\r
99bdfd31 850.global BackFill\r
cc68a136 851\r
852BackFill:\r
853 stmfd sp!, {r4-r9,lr}\r
854\r
88fd63ad 855 ldr lr, [r2, #OFS_EST_HighCol]\r
6bfa97ff 856 orr r0, r0, r1, lsl #7\r
cc68a136 857 orr r0, r0, r0, lsl #8\r
858 orr r0, r0, r0, lsl #16\r
859\r
860 mov r1, r0\r
861 mov r2, r0\r
862 mov r3, r0\r
863 mov r4, r0\r
864 mov r5, r0\r
865 mov r6, r0\r
866 mov r7, r0\r
867\r
868 @ go go go!\r
0c9c8e47 869 add lr, lr, #8\r
cc68a136 870 stmia lr!, {r0-r7} @ 10*8*4\r
871 stmia lr!, {r0-r7}\r
872 stmia lr!, {r0-r7}\r
873 stmia lr!, {r0-r7}\r
874 stmia lr!, {r0-r7}\r
875 stmia lr!, {r0-r7}\r
876 stmia lr!, {r0-r7}\r
877 stmia lr!, {r0-r7}\r
878 stmia lr!, {r0-r7}\r
879 stmia lr!, {r0-r7}\r
880\r
47677a2a 881 ldmfd sp!, {r4-r9,pc}\r
cc68a136 882\r
883\r
884@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
885\r
ea38612f 886@ void DrawTilesFromCache(int *hc, int sh, int rlim, struct PicoEState *est)\r
cc68a136 887\r
ea38612f 888.global DrawTilesFromCache\r
cc68a136 889\r
890DrawTilesFromCache:\r
ea38612f 891 stmfd sp!, {r4-r9,r11,lr}\r
cc68a136 892\r
cc68a136 893 @ cache some stuff to avoid mem access\r
88fd63ad 894 ldr r11,[r3, #OFS_EST_HighCol]\r
cc68a136 895 mov r12,#0xf\r
88fd63ad 896 ldr lr, [r3, #OFS_EST_PicoMem_vram]\r
ea38612f 897 mov r9, r3 @ est\r
cc68a136 898\r
7a7c6476 899 ands r8, r1, #1\r
900 orr r8, r8, r2, lsl #1\r
740da8c6 901 bne .dtfc_check_rendflags\r
902\r
cc68a136 903 @ scratch: r4, r7\r
904.dtfc_loop:\r
905 ldr r6, [r0], #4 @ read code\r
906 movs r1, r6, lsr #16 @ r1=dx;\r
ea38612f 907 ldmeqfd sp!, {r4-r9,r11,pc} @ dx is never zero, this must be a terminator, return\r
7a7c6476 908 bic r4, r1, #0xfe00\r
909 add r1, r11, r4 @ r1=pdest\r
cc68a136 910\r
47677a2a 911 ldr r2, [r0], #4 @ read pixel data\r
cc68a136 912\r
47677a2a 913 and r3, r6, #0x6000\r
cc68a136 914 mov r3, r3, lsr #9 @ r3=pal=((code&0x6000)>>9);\r
915\r
7a7c6476 916 rsbs r4, r4, r8, lsr #1\r
917 bmi .dtfc_cut_tile\r
918\r
919 tst r8, #1\r
cc68a136 920 bne .dtfc_shadow\r
921\r
922 tst r2, r2\r
923 beq .dtfc_loop\r
924\r
925 cmp r2, r2, ror #4\r
926 beq .dtfc_SingleColor @ tileline singlecolor \r
927\r
47677a2a 928 tst r6, #0x0800\r
7a7c6476 929 bne .dtfc_TileFlip\r
cc68a136 930\r
931 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
cc68a136 932.dtfc_TileNorm:\r
933 TileNorm r12\r
934 b .dtfc_loop\r
935\r
7a7c6476 936.dtfc_TileFlip:\r
937 TileFlip r12\r
938 b .dtfc_loop\r
939\r
cc68a136 940.dtfc_SingleColor:\r
941 and r4, r2, #0xf\r
942 orr r4, r3, r4\r
943 orr r4, r4, r4, lsl #8\r
944 tst r1, #1 @ not aligned?\r
945 strneb r4, [r1], #1\r
946 streqh r4, [r1], #2\r
947 strh r4, [r1], #2\r
948 strh r4, [r1], #2\r
949 strh r4, [r1], #2\r
950 strneb r4, [r1], #1 @ have a remaining unaligned pixel?\r
951 b .dtfc_loop\r
952\r
953.dtfc_shadow:\r
954 tst r2, r2\r
955 beq .dtfc_shadow_blank\r
956\r
957 cmp r2, r2, ror #4\r
958 beq .dtfc_SingleColor @ tileline singlecolor \r
959\r
47677a2a 960 tst r6, #0x0800\r
7a7c6476 961 bne .dtfc_TileFlipShHP\r
cc68a136 962\r
963 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
cc68a136 964.dtfc_TileNormShHP:\r
965 TileNormShHP\r
966 b .dtfc_loop\r
967\r
7a7c6476 968.dtfc_TileFlipShHP:\r
969 TileFlipShHP\r
970 b .dtfc_loop\r
971\r
cc68a136 972.dtfc_shadow_blank:\r
07abbab1 973 tst r1, #1\r
974 ldrneb r4, [r1]\r
6bfa97ff 975 mov r6, #0x7f\r
976 and r4, r4, r6\r
07abbab1 977 strneb r4, [r1], #1\r
978 ldrh r4, [r1]\r
979 orr r6, r6, r6, lsl #8\r
980 and r4, r4, r6\r
981 strh r4, [r1], #2\r
982 ldrh r4, [r1]\r
983 and r4, r4, r6\r
984 strh r4, [r1], #2\r
985 ldrh r4, [r1]\r
986 and r4, r4, r6\r
987 strh r4, [r1], #2\r
988 ldrh r4, [r1]\r
989 and r4, r4, r6\r
990 streqh r4, [r1]\r
991 strneb r4, [r1]\r
cc68a136 992 b .dtfc_loop\r
993\r
7a7c6476 994.dtfc_cut_tile:\r
1fad746a 995 cmn r4, #8\r
996 ble .dtfc_loop @ off limits\r
997\r
998 rsb r4, r4, #0 @ 1-7\r
7a7c6476 999 mov r4, r4, lsl #2\r
1fad746a 1000 mvn r12,#0\r
47677a2a 1001 tst r6, #0x0800 @ flipped?\r
1fad746a 1002 moveq r12,r12, lsl r4\r
1003 movne r12,r12, lsr r4\r
11a1966b 1004 and r2, r2, r12, ror #16\r
7a7c6476 1005 mov r12,#0xf\r
1006 tst r8, #1\r
1007 bne .dtfc_shadow\r
1008 tst r2, r2\r
1009 beq .dtfc_loop\r
47677a2a 1010 tst r6, #0x0800\r
7a7c6476 1011 beq .dtfc_TileNorm\r
1012 b .dtfc_TileFlip\r
1013\r
740da8c6 1014@ check if we have detected layer covered with hi-prio tiles:\r
1015.dtfc_check_rendflags:\r
88fd63ad 1016 ldr r2, [r9, #OFS_EST_rendstatus]\r
283fec1b 1017 tst r2, #(PDRAW_PLANE_HI_PRIO|PDRAW_SHHI_DONE)\r
740da8c6 1018 beq .dtfc_loop\r
7a7c6476 1019 bic r8, r8, #1 @ sh/hi mode off\r
283fec1b 1020 tst r2, #PDRAW_SHHI_DONE\r
740da8c6 1021 bne .dtfc_loop @ already processed\r
283fec1b 1022 orr r2, r2, #PDRAW_SHHI_DONE\r
88fd63ad 1023 str r2, [r9, #OFS_EST_rendstatus]\r
740da8c6 1024\r
1025 add r1, r11,#8\r
07abbab1 1026 mov r3, #320/4/4\r
6bfa97ff 1027 mov r6, #0x7f\r
740da8c6 1028 orr r6, r6, r6, lsl #8\r
1029 orr r6, r6, r6, lsl #16\r
1030.dtfc_loop_shprep:\r
07abbab1 1031 ldmia r1, {r2,r4,r5,r7}\r
740da8c6 1032 subs r3, r3, #1\r
07abbab1 1033 and r2, r2, r6\r
1034 and r4, r4, r6\r
1035 and r5, r5, r6\r
1036 and r7, r7, r6\r
1037 stmia r1!,{r2,r4,r5,r7}\r
1038 bne .dtfc_loop_shprep\r
1039\r
07abbab1 1040 b .dtfc_loop\r
740da8c6 1041\r
cc68a136 1042.pool\r
1043\r
1044@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
1045\r
1046\r
ea38612f 1047@ void DrawSpritesSHi(unsigned char *sprited, struct PicoEState *est)\r
1048\r
1049.global DrawSpritesSHi\r
e352c3af 1050\r
1051DrawSpritesSHi:\r
5f0d224e 1052 ldrb r3, [r0]\r
fbc65db7 1053 mov r12,#0xff\r
e352c3af 1054 ands r3, r3, #0x7f\r
1055 bxeq lr\r
cc68a136 1056\r
5f0d224e 1057 stmfd sp!, {r1,r3-r11,lr} @ +est\r
1058 strb r12,[r0,#3] @ set end marker\r
1059 ldrb r12,[r0,#1]\r
1060 add r10,r0, #4 @ r10=HighLnSpr end\r
1061 mvn r12,r12\r
1062 tst r12,#0x6 @ masking in slot 1 and tile ovfl?\r
1063 ldmeqfd sp!, {r1,r3-r11,pc}\r
e352c3af 1064 add r10,r10,r3 @ r10=HighLnSpr end\r
1065\r
5f0d224e 1066 ldrb r12,[r10,#0] @ width of last sprite\r
88fd63ad 1067 ldr r11,[r1, #OFS_EST_HighCol]\r
5f0d224e 1068 str r12,[sp, #4]\r
ea8c405f 1069 mov r12,#0xf\r
88fd63ad 1070 ldr lr, [r1, #OFS_EST_PicoMem_vram]\r
cc68a136 1071\r
cc68a136 1072\r
e352c3af 1073DrawSpriteSHi:\r
1074 @ draw next sprite\r
ea38612f 1075 ldr r7, [sp] @ est\r
47548249 1076 ldrb r0, [r10,#-1]!\r
88fd63ad 1077 ldr r1, [r7, #OFS_EST_HighPreSpr]\r
e352c3af 1078 cmp r0, #0xff\r
5f0d224e 1079 ldmeqfd sp!, {r1,r3-r11,pc} @ end of list\r
e352c3af 1080 and r0, r0, #0x7f\r
1081 add r0, r1, r0, lsl #3\r
1082\r
1083 ldr r9, [r0, #4] @ sprite[1]\r
1084 mov r2, r9, asr #16 @ r2=sx\r
cc68a136 1085\r
e352c3af 1086 mov r9, r9, lsl #16\r
1087 mov r3, r9, lsr #31 @ priority\r
1088 mov r9, r9, lsr #16\r
fbc65db7 1089@ orr r9, r9, r8, lsl #31 @ r9=code|sh[31] @@ sh is always on here now\r
e352c3af 1090 and r4, r9, #0x6000\r
1091 orr r9, r9, r4, lsl #16\r
fbc65db7 1092 orr r9, r9, #0x90000000 @ r9=scc1 ???? ... <code> (s=shadow/hilight, cc=pal)\r
e352c3af 1093 cmp r12,r9, lsr #28 @ sh/hi with pal3?\r
e54507e8 1094 cmpne r3, #1 @ if not, is it hi prio?\r
47548249 1095 strne r3, [sp, #4] @ reset last sprite width\r
e352c3af 1096 bne DrawSpriteSHi @ non-operator low sprite, already drawn\r
cc68a136 1097\r
e352c3af 1098 ldr r3, [r0] @ sprite[0]\r
e352c3af 1099 mov r6, r3, lsr #28\r
1100 sub r6, r6, #1 @ r6=width-1 (inc later)\r
1101 mov r5, r3, lsr #24\r
1102 and r5, r5, #7 @ r5=height\r
cc68a136 1103\r
88fd63ad 1104 ldr r7, [r7, #OFS_EST_DrawScanline]\r
e352c3af 1105 mov r0, r3, lsl #16 @ r4=sy<<16 (tmp)\r
cc68a136 1106\r
e352c3af 1107 sub r7, r7, r0, asr #16 @ r7=row=DrawScanline-sy\r
cc68a136 1108\r
e352c3af 1109 tst r9, #0x1000\r
1110 movne r0, r5, lsl #3\r
1111 subne r0, r0, #1\r
1112 subne r7, r0, r7 @ if (code&0x1000) row=(height<<3)-1-row; // Flip Y\r
cc68a136 1113\r
e352c3af 1114 add r8, r9, r7, lsr #3 @ tile+=row>>3; // Tile number increases going down\r
1115 tst r9, #0x0800\r
1116 mlane r8, r5, r6, r8 @ if (code&0x0800) { tile+=delta*(width-1);\r
1117 rsbne r5, r5, #0 @ delta=-delta; } // r5=delta now\r
cc68a136 1118\r
e352c3af 1119 mov r8, r8, lsl #21\r
1120 mov r8, r8, lsr #17\r
1121 and r7, r7, #7\r
1122 add r8, r8, r7, lsl #1 @ tile+=(row&7)<<1; // Tile address\r
1123\r
5f0d224e 1124 ldr r0, [sp, #4]\r
1125 add r6, r6, #1 @ inc now\r
1126 cmp r0, #0 @ check width of last sprite\r
1127 movne r6, r0\r
1128 movne r0, #0\r
1129 strne r0, [sp, #4]\r
1130\r
e352c3af 1131 mov r5, r5, lsl #4 @ delta<<=4; // Delta of address\r
e352c3af 1132 mov r3, r4, lsr #9 @ r3=pal=((code>>9)&0x30);\r
1133\r
e352c3af 1134 adds r0, r2, #0 @ mov sx to r0 and set ZV flags\r
1135 b .dsprShi_loop_enter\r
1136\r
1137.dsprShi_loop:\r
1138 subs r6, r6, #1 @ width--\r
1139 beq DrawSpriteSHi\r
1140 adds r0, r0, #8 @ sx+=8\r
1141 add r8, r8, r5 @ tile+=delta\r
1142\r
1143.dsprShi_loop_enter:\r
1144 ble .dsprShi_loop @ sx <= 0\r
cc68a136 1145 cmp r0, #328\r
e352c3af 1146 bge DrawSpriteSHi\r
cc68a136 1147\r
11a1966b 1148 bic r8, r8, #0xf8000 @ tile&=0x7fff; // Clip tile address\r
88fd63ad 1149 ldr r2, [lr, r8, lsl #1] @ pack=*(unsigned int *)(PicoMem.vram+addr); // Get 8 pixels\r
e352c3af 1150 add r1, r11, r0 @ r1=pdest\r
cc68a136 1151 tst r2, r2\r
e352c3af 1152 beq .dsprShi_loop\r
cc68a136 1153\r
e352c3af 1154 cmp r12, r9, lsr #28\r
1155 beq .dsprShi_shadow\r
cc68a136 1156\r
1157 cmp r2, r2, ror #4\r
e352c3af 1158 beq .dsprShi_SingleColor @ tileline singlecolor \r
cc68a136 1159\r
e352c3af 1160 tst r9, #0x0800\r
1161 bne .dsprShi_TileFlip\r
cc68a136 1162\r
e352c3af 1163 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
1164@ scratch: r4, r7\r
1165.dsprShi_TileNorm:\r
cc68a136 1166 TileNorm r12\r
e352c3af 1167 b .dsprShi_loop\r
cc68a136 1168\r
e352c3af 1169.dsprShi_TileFlip:\r
7a7c6476 1170 TileFlip r12\r
e352c3af 1171 b .dsprShi_loop\r
7a7c6476 1172\r
e352c3af 1173.dsprShi_SingleColor:\r
cc68a136 1174 and r4, r2, #0xf\r
1175 orr r4, r3, r4\r
1176 orr r4, r4, r4, lsl #8\r
e352c3af 1177 tst r0, #1 @ not aligned?\r
cc68a136 1178 strneb r4, [r1], #1\r
1179 streqh r4, [r1], #2\r
1180 strh r4, [r1], #2\r
1181 strh r4, [r1], #2\r
1182 strh r4, [r1], #2\r
1183 strneb r4, [r1], #1\r
e352c3af 1184 b .dsprShi_loop\r
cc68a136 1185\r
e352c3af 1186.dsprShi_shadow:\r
1187 tst r9, #0x8000\r
1188 beq .dsprShi_shadow_lowpri\r
07abbab1 1189\r
cc68a136 1190 cmp r2, r2, ror #4\r
e352c3af 1191 beq .dsprShi_singlec_sh\r
cc68a136 1192\r
e352c3af 1193 tst r9, #0x0800\r
1194 bne .dsprShi_TileFlip_sh\r
cc68a136 1195\r
e54507e8 1196 @ (r1=pdest, r2=pixels8, r3=pal) r4, r7: scratch, r12: helper pattern\r
e352c3af 1197.dsprShi_TileNorm_sh:\r
cc68a136 1198 TileNormSh\r
e352c3af 1199 b .dsprShi_loop\r
cc68a136 1200\r
e352c3af 1201.dsprShi_TileFlip_sh:\r
7a7c6476 1202 TileFlipSh\r
e352c3af 1203 b .dsprShi_loop\r
7a7c6476 1204\r
e352c3af 1205.dsprShi_singlec_sh:\r
cc68a136 1206 cmp r2, #0xe0000000\r
e352c3af 1207 bcc .dsprShi_SingleColor @ normal singlecolor tileline (carry inverted in ARM)\r
cc68a136 1208 tst r2, #0x10000000\r
e352c3af 1209 bne .dsprShi_sh_sh\r
cc68a136 1210 TileSingleHi\r
e352c3af 1211 b .dsprShi_loop\r
cc68a136 1212\r
e352c3af 1213.dsprShi_sh_sh:\r
cc68a136 1214 TileSingleSh\r
e352c3af 1215 b .dsprShi_loop\r
cc68a136 1216\r
e352c3af 1217.dsprShi_shadow_lowpri:\r
1218 tst r9, #0x800\r
1219 bne .dsprShi_TileFlip_sh_lp\r
07abbab1 1220\r
e352c3af 1221.dsprShi_TileNorm_sh_lp:\r
07abbab1 1222 TileNormSh_onlyop_lp\r
e352c3af 1223 b .dsprShi_loop\r
07abbab1 1224\r
e352c3af 1225.dsprShi_TileFlip_sh_lp:\r
07abbab1 1226 TileFlipSh_onlyop_lp\r
e352c3af 1227 b .dsprShi_loop\r
07abbab1 1228\r
cc68a136 1229.pool\r
1230\r
1231@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
1232\r
ea38612f 1233@ void DrawAllSprites(unsigned char *sprited, int prio, int sh,\r
1234@ struct PicoEState *est)\r
1235\r
1236.global DrawAllSprites\r
283fec1b 1237\r
1238DrawAllSprites:\r
fbc65db7 1239 orr r1, r2, r1, lsl #1\r
ea38612f 1240 ldr r2, [r0]\r
1241 ands r2, r2, #0x7f\r
283fec1b 1242 bxeq lr\r
1243\r
1244 @ time to do some real work\r
ea38612f 1245 stmfd sp!, {r1,r3-r11,lr} @ +sh|prio<<1 +est\r
283fec1b 1246 mov r12,#0xff\r
5f0d224e 1247 strb r12,[r0,#3] @ set end marker\r
1248 ldrb r12,[r0,#1]\r
1249 add r10,r0 ,#4\r
1250 mvn r12,r12\r
1251 tst r12,#0x6 @ masking in slot 1 and tile ovfl?\r
1252 ldmeqfd sp!, {r1,r3-r11,pc}\r
ea38612f 1253 add r10,r10,r2 @ r10=HighLnSpr end\r
283fec1b 1254\r
5f0d224e 1255 ldrb r12,[r10,#0] @ width of last sprite\r
88fd63ad 1256 ldr r11,[r3, #OFS_EST_HighCol]\r
5f0d224e 1257 orr r1 ,r1 ,r12,lsl #24\r
1258 str r1, [sp]\r
283fec1b 1259 mov r12,#0xf\r
88fd63ad 1260 ldr lr, [r3, #OFS_EST_PicoMem_vram]\r
283fec1b 1261\r
1262@ + 0 : hhhhvvvv ----hhvv yyyyyyyy yyyyyyyy // v, h: horiz. size\r
cc68a136 1263@ + 4 : xxxxxxxx xxxxxxxx pccvhnnn nnnnnnnn // x: x coord + 8\r
1264\r
ea38612f 1265DrawSprite:\r
283fec1b 1266 @ draw next sprite\r
1267 ldrb r0, [r10,#-1]!\r
5f0d224e 1268 ldr r4, [sp] @ sh|prio<<1|lastw<<24\r
ea38612f 1269 ldr r7, [sp, #4] @ est\r
5f0d224e 1270 mov r2, r0, lsl #24\r
e352c3af 1271 cmp r0, #0xff\r
ea38612f 1272 ldmeqfd sp!, {r1,r3-r11,pc} @ end of list\r
672b29e6 1273 eors r2, r2, r4, lsl #30\r
1274 bic r2, r4, #0xff000000\r
1275 str r2, [sp]\r
5f0d224e 1276 bmi DrawSprite @ wrong priority\r
88fd63ad 1277 ldr r1, [r7, #OFS_EST_HighPreSpr]\r
283fec1b 1278 and r0, r0, #0x7f\r
1279 add r0, r1, r0, lsl #3\r
cc68a136 1280\r
cc68a136 1281 ldr r3, [r0] @ sprite[0]\r
88fd63ad 1282 ldr r7, [r7, #OFS_EST_DrawScanline]\r
cc68a136 1283 mov r6, r3, lsr #28\r
1284 sub r6, r6, #1 @ r6=width-1 (inc later)\r
1285 mov r5, r3, lsr #24\r
1286 and r5, r5, #7 @ r5=height\r
1287\r
5f0d224e 1288 mov r8, r3, lsl #16 @ r8=sy<<16 (tmp)\r
cc68a136 1289\r
cc68a136 1290 ldr r9, [r0, #4]\r
5f0d224e 1291 sub r7, r7, r8, asr #16 @ r7=row=DrawScanline-sy\r
cc68a136 1292\r
cc68a136 1293 mov r2, r9, asr #16 @ r2=sx\r
e5fa9817 1294 mov r9, r9, lsl #16\r
1295 mov r9, r9, lsr #16\r
5f0d224e 1296 orr r9, r9, r4, lsl #31 @ r9=code|sh[31]\r
cc68a136 1297\r
1298 tst r9, #0x1000\r
5f0d224e 1299 movne r8, r5, lsl #3\r
1300 subne r8, r8, #1\r
1301 subne r7, r8, r7 @ if (code&0x1000) row=(height<<3)-1-row; // Flip Y\r
cc68a136 1302\r
07abbab1 1303 add r8, r9, r7, lsr #3 @ tile+=row>>3; // Tile number increases going down\r
cc68a136 1304 tst r9, #0x0800\r
1305 mlane r8, r5, r6, r8 @ if (code&0x0800) { tile+=delta*(width-1);\r
1306 rsbne r5, r5, #0 @ delta=-delta; } // r5=delta now\r
1307\r
07abbab1 1308 mov r8, r8, lsl #21\r
1309 mov r8, r8, lsr #17\r
cc68a136 1310 and r7, r7, #7\r
1311 add r8, r8, r7, lsl #1 @ tile+=(row&7)<<1; // Tile address\r
1312\r
5f0d224e 1313 add r6, r6, #1 @ inc now\r
1314 cmp r4, #0x1000000 @ check width of last sprite\r
1315 movhs r6, r4, lsr #24\r
5f0d224e 1316\r
cc68a136 1317 @ cache some stuff to avoid mem access\r
cc68a136 1318 mov r5, r5, lsl #4 @ delta<<=4; // Delta of address\r
1319 and r4, r9, #0x6000\r
1320 orr r9, r9, r4, lsl #16\r
97a7f774 1321 orrs r9, r9, #0x10000000 @ r9=scc1 ???? ... <code> (s=shadow/hilight, cc=pal)\r
cc68a136 1322\r
cc68a136 1323 mov r3, r4, lsr #9 @ r3=pal=((code>>9)&0x30);\r
6bfa97ff 1324 orrmi r3, r3, #0x80 @ for sh/hi\r
cc68a136 1325\r
cc68a136 1326 adds r0, r2, #0 @ mov sx to r0 and set ZV flags\r
1327 b .dspr_loop_enter\r
1328\r
1329.dspr_loop:\r
1330 subs r6, r6, #1 @ width--\r
283fec1b 1331 beq DrawSprite\r
cc68a136 1332 adds r0, r0, #8 @ sx+=8\r
1333 add r8, r8, r5 @ tile+=delta\r
1334\r
1335.dspr_loop_enter:\r
1336 ble .dspr_loop @ sx <= 0\r
1337 cmp r0, #328\r
283fec1b 1338 bge DrawSprite\r
cc68a136 1339\r
11a1966b 1340 bic r8, r8, #0xf8000 @ tile&=0x7fff; // Clip tile address\r
88fd63ad 1341 ldr r2, [lr, r8, lsl #1] @ pack=*(unsigned int *)(PicoMem.vram+addr); // Get 8 pixels\r
cc68a136 1342 add r1, r11, r0 @ r1=pdest\r
1343 tst r2, r2\r
1344 beq .dspr_loop\r
1345\r
1346 cmp r12, r9, lsr #28\r
1347 beq .dspr_shadow\r
1348\r
08bbe7f8 1349 tst r9, #0x80000000\r
1350 bne .dspr_shnonsh\r
1351\r
cc68a136 1352 cmp r2, r2, ror #4\r
1353 beq .dspr_SingleColor @ tileline singlecolor \r
1354\r
1355 tst r9, #0x0800\r
7a7c6476 1356 bne .dspr_TileFlip\r
cc68a136 1357\r
1358 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
cc68a136 1359@ scratch: r4, r7\r
1360.dspr_TileNorm:\r
1361 TileNorm r12\r
1362 b .dspr_loop\r
1363\r
7a7c6476 1364.dspr_TileFlip:\r
1365 TileFlip r12\r
1366 b .dspr_loop\r
1367\r
07abbab1 1368.dspr_singlec_sh:\r
1369 cmp r2, #0xe0000000\r
e54507e8 1370 bcs .dspr_TileNorm_sh @ op. tileline, markop. XXX: maybe add a spec. handler?\r
07abbab1 1371\r
cc68a136 1372.dspr_SingleColor:\r
1373 and r4, r2, #0xf\r
1374 orr r4, r3, r4\r
1375 orr r4, r4, r4, lsl #8\r
1376 tst r0, #1 @ not aligned?\r
1377 strneb r4, [r1], #1\r
1378 streqh r4, [r1], #2\r
1379 strh r4, [r1], #2\r
1380 strh r4, [r1], #2\r
1381 strh r4, [r1], #2\r
1382 strneb r4, [r1], #1\r
1383 b .dspr_loop\r
1384\r
08bbe7f8 1385.dspr_shnonsh:\r
1386 tst r9, #0x0800\r
1387 bne .dspr_TileFlipNonSH\r
1388\r
1389 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
1390@ scratch: r4, r7\r
1391.dspr_TileNormNonSH:\r
1392 TileNormNonSH r12\r
1393 b .dspr_loop\r
1394\r
1395.dspr_TileFlipNonSH:\r
1396 TileFlipNonSH r12\r
1397 b .dspr_loop\r
1398\r
cc68a136 1399.dspr_shadow:\r
1400 cmp r2, r2, ror #4\r
1401 beq .dspr_singlec_sh\r
1402\r
1403 tst r9, #0x0800\r
7a7c6476 1404 bne .dspr_TileFlip_sh\r
cc68a136 1405\r
1406 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r12: helper pattern\r
cc68a136 1407.dspr_TileNorm_sh:\r
e54507e8 1408 TileNormSh_markop\r
cc68a136 1409 b .dspr_loop\r
1410\r
7a7c6476 1411.dspr_TileFlip_sh:\r
e54507e8 1412 TileFlipSh_markop\r
cc68a136 1413 b .dspr_loop\r
1414\r
1415\r
cc68a136 1416@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
1417\r
ea38612f 1418@ void DrawWindow(int tstart, int tend, int prio, int sh\r
1419@ struct PicoEState *est)\r
1420\r
1421.global DrawWindow\r
cc68a136 1422\r
1423DrawWindow:\r
ea38612f 1424 ldr r12, [sp] @ est\r
cc68a136 1425 stmfd sp!, {r4-r11,lr}\r
1426\r
88fd63ad 1427 ldr r6, [r12, #OFS_EST_Pico]\r
1428 ldr r10, [r12, #OFS_EST_DrawScanline]\r
ea38612f 1429 mov r11, r12 @ est\r
88fd63ad 1430 ldrb r12, [r6, #OFS_Pico_video_reg+3] @ pvid->reg[3]\r
cc68a136 1431\r
88fd63ad 1432 ldr r4, [r6, #OFS_Pico_video_reg+12]\r
cc68a136 1433 mov r5, r10, lsr #3\r
1434 and r10, r10, #7\r
1435 mov r10, r10, lsl #1 @ r10=ty\r
1436\r
cbb9a098 1437 ldr r6, [r11, #OFS_EST_rendstatus]\r
1438 ldr lr, [r11, #OFS_EST_PicoMem_vram]\r
1439\r
cc68a136 1440 mov r12, r12, lsl #10\r
1441\r
1442 tst r4, #1 @ 40 cell mode?\r
1443 andne r12, r12, #0xf000 @ 0x3c<<10\r
1444 andeq r12, r12, #0xf800\r
1445 addne r12, r12, r5, lsl #7\r
1446 addeq r12, r12, r5, lsl #6 @ nametab\r
1447 add r12, r12, r0, lsl #2 @ +starttile\r
1448\r
47677a2a 1449 ands r6, r6, #PDRAW_WND_DIFF_PRIO\r
1450 cmpeq r2, #1 @ prio && !(rendstatus & WND_DIFF_PRIO)?\r
7292c709 1451 ldmeqfd sp!, {r4-r11,pc} @ yes, assume that whole window uses same priority\r
cc68a136 1452\r
47548249 1453 orr r6, r6, r2\r
cc68a136 1454 orr r6, r6, r3, lsl #8 @ shadow mode\r
1455\r
1456 sub r8, r1, r0\r
cc68a136 1457\r
1458 @ cache some stuff to avoid mem access\r
88fd63ad 1459 ldr r11, [r11, #OFS_EST_HighCol]\r
ea8c405f 1460 mov r8, r8, lsl #1 @ cells\r
ea8c405f 1461 mvn r9, #0 @ r9=prevcode=-1\r
cbb9a098 1462 add r1, r11, r0, lsl #4 @ r1=pdest=HighCol+starttile (+8 added in loop)\r
cc68a136 1463 mov r0, #0xf\r
cc68a136 1464\r
07abbab1 1465 @ r4,r5 are scratch in this loop\r
cc68a136 1466.dwloop:\r
1467 add r1, r1, #8\r
1468.dwloop_nor1:\r
cc68a136 1469 ldrh r7, [lr, r12] @ r7=code (int, but from unsigned, no sign extend)\r
cbb9a098 1470 add r12, r12, #2 @ halfwords\r
cc68a136 1471 subs r8, r8, #1\r
cbb9a098 1472 bmi .dwloop_end @ done\r
cc68a136 1473\r
1474 eor r5, r6, r7, lsr #15\r
1475 tst r5, #1\r
47677a2a 1476 orrne r6, r6, #PDRAW_WND_DIFF_PRIO @ wrong pri\r
cc68a136 1477 bne .dwloop\r
1478\r
1479 cmp r7, r9\r
1480 beq .dw_samecode @ we know stuff about this tile already\r
1481\r
cc68a136 1482 mov r9, r7 @ remember code\r
1483\r
11a1966b 1484 tst r9, #0x1000 @ if (code&0x1000)\r
1485 mov r2, r9, lsl #21\r
1486 add r2, r2, r10, lsl #17\r
1487 eorne r2, r2, #0xe<<17 @ if (code&0x1000) addr^=0xe;\r
1488\r
1489 ldr r2, [lr, r2, lsr #16] @ pack=*(unsigned int *)(Pico.vram+addr); // Get 8 pixels\r
cc68a136 1490\r
1491 and r3, r9, #0x6000\r
1492 mov r3, r3, lsr #9 @ r3=pal=((code&0x6000)>>9);\r
1493\r
cc68a136 1494.dw_samecode:\r
1495 tst r6, #0x100\r
1496 bne .dw_shadow\r
1497.dw_shadow_done:\r
1498 tst r2, r2\r
1499 beq .dwloop @ tileline blank\r
1500\r
1501 cmp r2, r2, ror #4\r
1502 beq .dw_SingleColor @ tileline singlecolor \r
1503\r
1504 tst r9, #0x0800\r
7a7c6476 1505 bne .dw_TileFlip\r
cc68a136 1506\r
1507 @ (r1=pdest, r2=pixels8, r3=pal) r4: scratch, r0: helper pattern\r
cc68a136 1508.dw_TileNorm:\r
1509 TileNorm r0\r
1510 b .dwloop\r
1511\r
7a7c6476 1512.dw_TileFlip:\r
1513 TileFlip r0\r
1514 b .dwloop\r
1515\r
cc68a136 1516.dw_SingleColor:\r
1517 and r4, r0, r2 @ #0x0000000f\r
1518 orr r4, r3, r4\r
1519 orr r4, r4, r4, lsl #8\r
1520 orr r4, r4, r4, lsl #16\r
1521 mov r5, r4\r
1522 stmia r1!, {r4,r5}\r
1523 b .dwloop_nor1 @ we incremeted r1 ourselves\r
1524\r
1525.dw_shadow:\r
1526 tst r6, #1 @ hi pri?\r
6bfa97ff 1527 orreq r3, r3, #0x80\r
cc68a136 1528 beq .dw_shadow_done\r
1529 ldr r4, [r1]\r
6bfa97ff 1530 mov r5, #0x7f\r
07abbab1 1531 orr r5, r5, r5, lsl #8\r
1532 orr r5, r5, r5, lsl #16\r
1533 and r4, r4, r5\r
cc68a136 1534 str r4, [r1]\r
1535 ldr r4, [r1,#4]\r
07abbab1 1536 and r4, r4, r5\r
cc68a136 1537 str r4, [r1,#4]\r
1538 b .dw_shadow_done\r
1539\r
1540.dwloop_end:\r
47677a2a 1541 and r2, r6, #PDRAW_WND_DIFF_PRIO\r
ea38612f 1542 ldmfd sp!, {r4-r11,lr}\r
1543 ldr r0, [sp]\r
88fd63ad 1544 ldr r1, [r0, #OFS_EST_rendstatus]\r
ea38612f 1545 orr r1, r1, r2\r
88fd63ad 1546 str r1, [r0, #OFS_EST_rendstatus]\r
cc68a136 1547\r
ea38612f 1548 bx lr\r
cc68a136 1549\r
1550\r
1551@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
1552\r
1553\r
cc68a136 1554@ Convert 0000bbb0 ggg0rrr0\r
1555@ to rrrrrggg gggbbbbb\r
1556\r
a39d8ba5 1557@ r2,r3 - scratch, lr = 0x001c001c, r8 = 0x08610861\r
cc68a136 1558.macro convRGB565 reg\r
a39d8ba5 1559 and r2, lr, \reg,lsr #7 @ b\r
1560 and r3, lr, \reg,lsr #3 @ g\r
1561 and \reg, lr, \reg,lsl #1 @ r\r
1562 orr r2, r2, r3, lsl #6\r
1563 orr \reg, r2, \reg,lsl #11\r
1564\r
1565 and r2, r8, \reg,lsr #4\r
1566 orr \reg, \reg, r2\r
cc68a136 1567.endm\r
1568\r
a39d8ba5 1569@ trashes: r2-r8,r12,lr; r8 = 0x08610861; r0,r1 are advanced\r
b2305d08 1570.macro vidConvCpyRGB565_local\r
2ec14aec 1571 mov r12, r2, lsr #3 @ repeats\r
cc68a136 1572 mov lr, #0x001c0000\r
1573 orr lr, lr, #0x01c @ lr == pattern 0x001c001c\r
cc68a136 1574\r
b2305d08 15750:\r
cc68a136 1576 ldmia r1!, {r4-r7}\r
1577 subs r12, r12, #1\r
1578 convRGB565 r4\r
1579 str r4, [r0], #4\r
1580 convRGB565 r5\r
1581 str r5, [r0], #4\r
1582 convRGB565 r6\r
1583 str r6, [r0], #4\r
1584 convRGB565 r7\r
1585 str r7, [r0], #4\r
1586\r
b2305d08 1587 bgt 0b\r
1588.endm\r
1589\r
1590\r
1591.global vidConvCpyRGB565\r
cc68a136 1592\r
b2305d08 1593vidConvCpyRGB565: @ void *to, void *from, int pixels\r
1594 stmfd sp!, {r4-r9,lr}\r
a39d8ba5 1595 mov r8, #0x0061\r
1596 orr r8, r8, #0x0800\r
f4750ee0 1597 orr r8, r8, r8, lsl #16\r
b2305d08 1598 vidConvCpyRGB565_local\r
47677a2a 1599 ldmfd sp!, {r4-r9,pc}\r
cc68a136 1600\r
1601\r
ea38612f 1602@ void PicoDoHighPal555(int sh, int line, struct PicoEState *est)\r
1603\r
1604.global PicoDoHighPal555\r
cc68a136 1605\r
b2305d08 1606PicoDoHighPal555:\r
ea38612f 1607 stmfd sp!, {r4-r10,lr}\r
1608 mov r10,r2 @ est\r
88fd63ad 1609 ldr r8, [r10, #OFS_EST_Pico]\r
cc68a136 1610\r
b1a047c9 1611 mov r9, r0\r
b2305d08 1612\r
88fd63ad 1613 add r0, r10, #OFS_EST_HighPal\r
b2305d08 1614\r
cc68a136 1615 mov r1, #0\r
88fd63ad 1616 strb r1, [r8, #OFS_Pico_m_dirtyPal]\r
b2305d08 1617\r
88fd63ad 1618 ldr r1, [r10, #OFS_EST_PicoMem_cram]\r
cc68a136 1619 mov r2, #0x40\r
a39d8ba5 1620 mov r8, #0x0061\r
1621 orr r8, r8, #0x0800\r
f4750ee0 1622 orr r8, r8, r8, lsl #16\r
a39d8ba5 1623\r
b2305d08 1624 vidConvCpyRGB565_local\r
cc68a136 1625\r
b1a047c9 1626 cmp r9, #0\r
b2305d08 1627 beq PicoDoHighPal555_end\r
1628\r
88fd63ad 1629 add r3, r10, #OFS_EST_HighPal\r
cc68a136 1630 add r4, r3, #0x40*2\r
cc68a136 1631\r
6bfa97ff 1632 @ hilighted pixels (0x40-0x7f):\r
a39d8ba5 1633 @ t = ((dpal[i] >> 1) & 0x738e738e) + 0x738e738e;\r
1634 @ t |= (t >> 4) & 0x08610861;\r
1635 @ r8=0x08610861\r
6bfa97ff 1636 mov r12, #0x008e\r
1637 orr r12,r12,#0x7300\r
1638 orr r12,r12,r12,lsl #16\r
a39d8ba5 1639 mov lr, #0x40/4\r
cc68a136 1640.fl_loopcpRGB555_hi:\r
a39d8ba5 1641 ldmia r3!, {r1,r6}\r
1642 and r1, r12, r1, lsr #1\r
1643 and r6, r12, r6, lsr #1\r
1644 add r1, r12, r1\r
1645 add r6, r12, r6\r
1646 and r5, r8, r1, lsr #4\r
1647 and r7, r8, r6, lsr #4\r
1648 orr r1, r1, r5\r
1649 orr r6, r6, r7\r
1650 stmia r4!, {r1,r6}\r
cc68a136 1651 subs lr, lr, #1\r
1652 bne .fl_loopcpRGB555_hi\r
1653\r
6bfa97ff 1654 sub r3, r3, #0x40*2\r
1655 @ shadowed (0x80-0xbf), shadow|hilight (aka normal, 0xc0-0xff) pixels:\r
1656 add r5, r3, #0xc0*2\r
1657 mov lr, #0x40/4\r
1658.fl_loopcpRGB555_sh:\r
1659 ldmia r3!, {r1,r6}\r
1660 subs lr, lr, #1\r
1661 stmia r5!, {r1,r6} @ 0xc0, normal\r
1662 and r1, r12, r1, lsr #1\r
1663 and r6, r12, r6, lsr #1\r
1664 stmia r4!, {r1,r6}\r
1665 bne .fl_loopcpRGB555_sh\r
1666\r
6bfa97ff 1667 mov r0, #1\r
b2305d08 1668PicoDoHighPal555_end:\r
b1a047c9 1669 ldmfd sp!, {r4-r10,pc}\r
b2305d08 1670\r
1671\r
ea38612f 1672@ void FinalizeLine555(int sh, int line, struct PicoEState *est)\r
1673\r
1674.global FinalizeLine555\r
b2305d08 1675\r
5a681086 1676FinalizeLine555:\r
d89e9fb0 1677 ldr r3, [r2, #OFS_EST_rendstatus]\r
f1dbe764 1678 mov r0, r2\r
1679 tst r3, #PDRAW_BGC_DMA\r
1680 bne BgcDMA\r
1681\r
52e4a905 1682 stmfd sp!, {r4-r11,lr}\r
1683 mov r11,r2 @ est\r
f1dbe764 1684 mov r4, r3\r
b2305d08 1685\r
b1a047c9 1686 bl PicoDrawUpdateHighPal\r
b2305d08 1687\r
db1ee7a2 1688 ldr r8, [r11, #OFS_EST_Pico]\r
52e4a905 1689 add r3, r11, #OFS_EST_HighPal\r
cc68a136 1690\r
e5fa9817 1691 mov lr, #0xff\r
466fa079 1692 mov lr, lr, lsl #1\r
e5fa9817 1693\r
52e4a905 1694 ldr r5, [r11, #OFS_EST_PicoOpt]\r
1695 ldr r1, [r11, #OFS_EST_HighCol]\r
1696 ldr r0, [r11, #OFS_EST_DrawLineDest]\r
466fa079 1697 ldr r7, [r5, #OFS_PicoIn_AHW-OFS_PicoIn_opt]\r
1698 ldrb r12,[r8, #OFS_Pico_video_reg+12]\r
96948bdf 1699 ldrb r6, [r8, #OFS_Pico_video_reg+0]\r
466fa079 1700 ldr r2, [r8, #OFS_Pico_m_hardware]\r
ea8c405f 1701 add r1, r1, #8\r
3d48f143 1702\r
a26e6639 1703 tst r7, #0x20 @ GG ?\r
1704 tstne r2, #0x2 @ LCD ?\r
1705 bne .fl_gg20col\r
1706\r
96948bdf 1707 tst r7, #0x10 @ SMS ?\r
1708 beq .fl_noSMS\r
1709\r
96948bdf 1710 tst r6, #0x20\r
1711 movne r2, #248/8 @ len = 248\r
1712 addne r1, r1, #8 @ ps += 8\r
1713 moveq r2, #256/8 @ len = 256\r
1714 b .fl_check32scaling\r
cc68a136 1715\r
96948bdf 1716.fl_gg20col:\r
466fa079 1717 mov r2, #160/8 @ len = 160\r
17c1401b 1718 tst r4, #PDRAW_SOFTSCALE\r
466fa079 1719 bne .fl_20scale_RGB555 @ scale 160->320\r
96948bdf 1720 b .fl_checkborder\r
466fa079 1721\r
96948bdf 1722.fl_noSMS:\r
466fa079 1723 tst r12, #1 @ h32?\r
1724 movne r2, #320/8 @ len = 320\r
96948bdf 1725 bne .fl_40colRGB555\r
1726 mov r2, #256/8 @ len = 256\r
1727\r
1728.fl_check32scaling:\r
17c1401b 1729 tst r4, #PDRAW_SOFTSCALE\r
96948bdf 1730 rsbne r7, r2, #256/8\r
1731 addne r0, r0, r7, lsl #3 @ pd += (256-len)>>1\r
466fa079 1732 bne .fl_32scale_RGB555 @ scale 256->320\r
3d48f143 1733\r
466fa079 1734.fl_checkborder:\r
17c1401b 1735 tst r4, #PDRAW_BORDER_32\r
1736 rsbne r7, r2, #320/8 @ pd += (320-len)/2\r
1737 addne r0, r0, r7, lsl #3\r
cc68a136 1738\r
96948bdf 1739.fl_40colRGB555:\r
f62850ba 1740#ifdef UNALIGNED_DRAWLINEDEST\r
499a0be3 1741 @ this is basically for Gizmondo, which has unaligned odd lines in the framebuffer\r
1742 tst r0, #2\r
1743 bne .fl_RGB555u\r
f62850ba 1744#endif\r
499a0be3 1745\r
1746.fl_loopRGB555:\r
cc68a136 1747 ldr r12, [r1], #4\r
1748 ldr r7, [r1], #4\r
1749\r
1750 and r4, lr, r12, lsl #1\r
1751 ldrh r4, [r3, r4]\r
1752 and r5, lr, r12, lsr #7\r
1753 ldrh r5, [r3, r5]\r
1754 and r6, lr, r12, lsr #15\r
1755 ldrh r6, [r3, r6]\r
1756 orr r4, r4, r5, lsl #16\r
1757\r
1758 and r5, lr, r12, lsr #23\r
1759 ldrh r5, [r3, r5]\r
1760 and r8, lr, r7, lsl #1\r
1761 ldrh r8, [r3, r8]\r
1762 orr r5, r6, r5, lsl #16\r
1763\r
1764 and r6, lr, r7, lsr #7\r
1765 ldrh r6, [r3, r6]\r
1766 and r12,lr, r7, lsr #15\r
1767 ldrh r12,[r3, r12]\r
499a0be3 1768 and r7, lr, r7, lsr #23\r
1769 ldrh r7, [r3, r7]\r
cc68a136 1770 orr r8, r8, r6, lsl #16\r
1771\r
cc68a136 1772 subs r2, r2, #1\r
499a0be3 1773 orr r12,r12, r7, lsl #16\r
cc68a136 1774\r
1775 stmia r0!, {r4,r5,r8,r12}\r
1776 bne .fl_loopRGB555\r
1777\r
52e4a905 1778 ldmfd sp!, {r4-r11,pc}\r
3d48f143 1779\r
1780\r
1781.fl_32scale_RGB555:\r
d5d17782 1782 ldr r5, [r5, #OFS_PicoIn_filter-OFS_PicoIn_opt]\r
1783\r
1784 mov r9, #0xf700 @ f800 07e0 001f | e000 0780 001c | 3800 01e0 0007\r
1785 orr r9, r9, #0x00de\r
3d48f143 1786\r
f62850ba 1787#ifdef UNALIGNED_DRAWLINEDEST\r
499a0be3 1788 tst r0, #2\r
1789 bne .fl_32scale_RGB555u\r
f62850ba 1790#endif\r
499a0be3 1791\r
466fa079 1792 and r5, r5, #0x3\r
1793 add pc, pc, r5, lsl #2\r
1794 nop\r
d5d17782 1795 b .fl_32scale_nn\r
1796 b .fl_32scale_snn\r
1797 b .fl_32scale_bl2\r
1798 b .fl_32scale_bl4\r
1799\r
1800.fl_32scale_nn:\r
1801 ldr r12, [r1], #4\r
1802 ldr r7, [r1], #4\r
1803\r
1804 and r4, lr, r12, lsl #1\r
1805 ldrh r4, [r3, r4]\r
1806 and r5, lr, r12, lsr #7\r
1807 ldrh r5, [r3, r5]\r
1808 and r6, lr, r12, lsr #15\r
1809 ldrh r6, [r3, r6]\r
1810 and r10,lr, r12, lsr #23\r
1811 ldrh r10,[r3, r10]\r
1812\r
1813 orr r4, r4, r5, lsl #16\r
1814 orr r5, r6, r6, lsl #16\r
1815\r
1816 and r6, lr, r7, lsl #1\r
1817 ldrh r6, [r3, r6]\r
1818 and r8, lr, r7, lsr #7\r
1819 ldrh r8, [r3, r8]\r
1820 and r12,lr, r7, lsr #15\r
1821 ldrh r12,[r3, r12]\r
1822 and r7, lr, r7, lsr #23\r
1823 ldrh r7, [r3, r7]\r
1824\r
1825 orr r6, r10,r6, lsl #16\r
1826 orr r8, r8,r12, lsl #16\r
1827\r
1828 subs r2, r2, #1\r
1829\r
1830 orr r10,r12,r7, lsl #16\r
1831\r
1832 stmia r0!, {r4,r5,r6,r8,r10}\r
1833 bne .fl_32scale_nn\r
1834\r
52e4a905 1835 b .fl_32scale_8bit\r
d5d17782 1836\r
1837.fl_32scale_snn:\r
1838 ldr r12, [r1], #4\r
1839 ldr r7, [r1], #4\r
1840\r
1841 and r4, lr, r12, lsl #1\r
1842 ldrh r4, [r3, r4]\r
1843 and r5, lr, r12, lsr #7\r
1844 ldrh r5, [r3, r5]\r
1845 and r6, lr, r12, lsr #15\r
1846 ldrh r6, [r3, r6]\r
1847 and r10,lr, r12, lsr #23\r
1848 ldrh r10,[r3, r10]\r
1849\r
1850 and r4, r4, r9\r
1851 and r5, r5, r9\r
1852 orr r4, r4, r5, lsl #16\r
1853 and r6, r6, r9\r
1854 add r5, r5, r6\r
1855 mov r5, r5, lsr #1\r
1856 orr r5, r5, r6, lsl #16\r
1857\r
1858 and r6, lr, r7, lsl #1\r
1859 ldrh r6, [r3, r6]\r
1860 and r8, lr, r7, lsr #7\r
1861 ldrh r8, [r3, r8]\r
1862 and r12,lr, r7, lsr #15\r
1863 ldrh r12,[r3, r12]\r
1864 and r7, lr, r7, lsr #23\r
1865 ldrh r7, [r3, r7]\r
1866\r
1867 and r6, r6, r9\r
1868 and r10,r10,r9\r
1869 orr r6, r10,r6, lsl #16\r
1870 and r12,r12,r9\r
1871 and r7, r7, r9\r
1872 orr r10,r12,r7, lsl #16\r
1873\r
1874 and r8, r8, r9\r
1875 add r12,r12,r8\r
1876 mov r12,r12,lsr #1\r
1877 orr r8, r8,r12, lsl #16\r
1878\r
1879 subs r2, r2, #1\r
1880\r
1881 stmia r0!, {r4,r5,r6,r8,r10}\r
1882 bne .fl_32scale_snn\r
1883\r
52e4a905 1884 b .fl_32scale_8bit\r
d5d17782 1885\r
1886.fl_32scale_bl2:\r
1887 ldr r12, [r1], #4\r
1888 ldr r7, [r1], #4\r
1889\r
1890 and r4, lr, r12, lsl #1\r
1891 ldrh r4, [r3, r4]\r
1892 and r5, lr, r12, lsr #7\r
1893 ldrh r5, [r3, r5]\r
1894 and r6, lr, r12, lsr #15\r
1895 ldrh r6, [r3, r6]\r
1896\r
1897 and r4, r4, r9\r
1898 and r5, r5, r9\r
1899 add r10,r4, r5\r
1900 mov r10,r10,lsr #1\r
1901 orr r4, r4, r10,lsl #16 @ px0 | (px0+px1)/2\r
1902\r
1903 and r6, r6, r9\r
1904 add r5, r5, r6\r
1905 mov r5, r5, lsr #1\r
1906 orr r5, r5, r6, lsl #16 @ (px1+px2)/2 | px2\r
1907\r
1908 and r10,lr, r12, lsr #23\r
1909 ldrh r10,[r3, r10]\r
1910 and r8, lr, r7, lsl #1\r
1911 ldrh r8, [r3, r8]\r
1912\r
1913 and r10,r10,r9\r
1914 and r8, r8, r9\r
1915 orr r6, r10,r8, lsl #16 @ px3 | px4\r
1916\r
1917 and r12,lr, r7, lsr #15\r
1918 ldrh r12,[r3, r12]\r
1919 and r10, lr, r7, lsr #23\r
1920 ldrh r10, [r3, r10]\r
1921 and r7, lr, r7, lsr #7\r
1922 ldrh r7, [r3, r7]\r
1923\r
1924 and r12,r12,r9\r
1925 and r10,r10,r9\r
1926 orr r10,r12,r10, lsl #16 @ px6 | px7\r
1927\r
1928 and r7, r7, r9\r
1929 add r12,r12,r7\r
1930 add r8, r8, r7\r
1931 mov r8, r8, lsr #1\r
1932 mov r12,r12,lsr #1\r
1933 orr r8, r8,r12, lsl #16 @ (px4+px5)/2 | (px5+px6)/2\r
1934\r
1935 subs r2, r2, #1\r
1936\r
1937 stmia r0!, {r4,r5,r6,r8,r10}\r
1938 bne .fl_32scale_bl2\r
1939\r
52e4a905 1940 b .fl_32scale_8bit\r
d5d17782 1941\r
1942.fl_32scale_bl4:\r
466fa079 1943 // TODO this should reflect the bl4 C algorithm, but it doesn't, it's bln.\r
1944 and r9, r9, r9, lsl #1 @ nuke 2 LSBs to avoid spilling for n/4\r
1945.fl_32loop_bl4:\r
3d48f143 1946 ldr r12, [r1], #4\r
1947 ldr r7, [r1], #4\r
cc68a136 1948\r
3d48f143 1949 and r4, lr, r12,lsl #1\r
1950 ldrh r4, [r3, r4]\r
1951 and r5, lr, r12,lsr #7\r
1952 ldrh r5, [r3, r5]\r
d5d17782 1953\r
1954 @ r4 = 1/4px0+3/4px1 : px0\r
1955 and r4, r4, r9\r
3d48f143 1956 orr r4, r4, r4, lsl #14 @ r4[31:16] = 1/4 pix_s 0\r
d5d17782 1957 and r5, r5, r9\r
3d48f143 1958 sub r6, r5, r5, lsr #2 @ r6 = 3/4 pix_s 1\r
1959 add r4, r4, r6, lsl #16 @ pix_d 0, 1\r
d5d17782 1960\r
3d48f143 1961 and r6, lr, r12,lsr #15\r
1962 ldrh r6, [r3, r6]\r
1963 and r12,lr, r12,lsr #23\r
1964 ldrh r12,[r3, r12]\r
d5d17782 1965\r
1966 @ r5 = 3/4px2+1/4px3 : (px1+px2)/2\r
1967 and r6, r6, r9\r
3d48f143 1968 add r5, r5, r6\r
1969 mov r5, r5, lsr #1\r
1970 sub r6, r6, r6, lsr #2 @ r6 = 3/4 pix_s 2\r
1971 orr r5, r5, r6, lsl #16\r
1972\r
1973 and r6, lr, r7, lsl #1\r
1974 ldrh r6, [r3, r6]\r
d5d17782 1975 and r12,r12,r9\r
3d48f143 1976 add r5, r5, r12,lsl #14 @ pix_d 2, 3\r
d5d17782 1977\r
1978 @ r6 = px4 : px3\r
1979 and r6, r6, r9\r
3d48f143 1980 orr r6, r12,r6, lsl #16 @ pix_d 4, 5\r
1981\r
d5d17782 1982 @ r8 = (px5+px6)/2 : 1/4px4+3/4px5\r
3d48f143 1983 and r12,lr, r7, lsr #7\r
1984 ldrh r12,[r3, r12]\r
1985 and r10,lr, r7, lsr #15\r
1986 ldrh r10,[r3, r10]\r
d5d17782 1987 and r12,r12,r9\r
3d48f143 1988 sub r8, r12,r12,lsr #2 @ r8 = 3/4 pix_s 1\r
1989 add r8, r8, r6, lsr #18\r
d5d17782 1990\r
3d48f143 1991 and r7, lr, r7, lsr #23\r
1992 ldrh r7, [r3, r7]\r
d5d17782 1993 and r10,r10,r9\r
3d48f143 1994 orr r8, r8, r10,lsl #15\r
1995 add r8, r8, r12,lsl #15 @ pix_d 6, 7\r
d5d17782 1996\r
1997 @ r10 = px7 : 3/4px6+1/4px7\r
3d48f143 1998 sub r10,r10,r10,lsr #2 @ r10= 3/4 pix_s 2\r
d5d17782 1999 and r7, r7, r9\r
3d48f143 2000 add r10,r10,r7, lsr #2 @ += 1/4 pix_s 3\r
2001 orr r10,r10,r7, lsl #16 @ pix_d 8, 9\r
2002\r
2003 subs r2, r2, #1\r
2004\r
2005 stmia r0!, {r4,r5,r6,r8,r10}\r
466fa079 2006 bne .fl_32loop_bl4\r
2007\r
52e4a905 2008.fl_32scale_8bit:\r
2009 ldr r4, [r11, #OFS_EST_rendstatus]\r
2010 add r0, r1, #320-256\r
2011 mov r2, #256/8\r
2012 tst r4, #PDRAW_32X_SCALE\r
2013 ldmeqfd sp!, {r4-r11,pc}\r
2014 mov lr, #0xff\r
2015\r
2016.fl_32scale_8bit_nn:\r
2017 ldr r7, [r1, #-4]!\r
2018 ldr r12, [r1, #-4]!\r
2019\r
2020 and r4, lr, r12, lsl #0\r
2021 and r5, lr, r12, lsr #8\r
2022 and r6, lr, r12, lsr #16\r
2023 and r10,lr, r12, lsr #24\r
2024 \r
2025 orr r4, r4, r5, lsl #8\r
2026 orr r5, r6, r6, lsl #8\r
2027\r
2028 and r6, lr, r7, lsl #0\r
2029 and r8, lr, r7, lsr #8\r
2030 and r12,lr, r7, lsr #16\r
2031 and r7, lr, r7, lsr #24\r
2032\r
2033 orr r6, r10,r6, lsl #8\r
2034 orr r8, r8,r12, lsl #8\r
2035\r
2036 subs r2, r2, #1\r
2037\r
2038 orr r10,r12,r7, lsl #8\r
2039\r
2040 strh r10, [r0, #-2]!\r
2041 strh r8, [r0, #-2]!\r
2042 strh r6, [r0, #-2]!\r
2043 strh r5, [r0, #-2]!\r
2044 strh r4, [r0, #-2]!\r
2045\r
2046 bne .fl_32scale_8bit_nn\r
2047\r
2048 ldmfd sp!, {r4-r11,pc}\r
2049\r
466fa079 2050\r
2051.fl_20scale_RGB555:\r
2052 ldr r5, [r5, #OFS_PicoIn_filter-OFS_PicoIn_opt]\r
2053\r
2054 mov r9, #0xf700 @ f800 07e0 001f | e000 0780 001c | 3800 01e0 0007\r
2055 orr r9, r9, #0x00de\r
2056\r
2057#ifdef UNALIGNED_DRAWLINEDEST\r
2058 tst r0, #2\r
2059 bne .fl_20scale_RGB555u\r
2060#endif\r
2061\r
2062 and r5, r5, #0x2\r
2063 add pc, pc, r5, lsl #1\r
2064 nop\r
2065 b .fl_20scale_nn\r
2066 b .fl_20scale_bl2\r
2067\r
2068.fl_20scale_nn:\r
2069 ldr r12, [r1], #4\r
2070 ldr r7, [r1], #4\r
2071\r
2072 and r4, lr, r12, lsl #1\r
2073 ldrh r4, [r3, r4]\r
2074 and r5, lr, r12, lsr #7\r
2075 ldrh r5, [r3, r5]\r
2076 and r6, lr, r12, lsr #15\r
2077 ldrh r6, [r3, r6]\r
2078 and r8 ,lr, r12, lsr #23\r
a2018ca1 2079 ldrh r8 ,[r3, r8]\r
466fa079 2080\r
2081 orr r4, r4, r4, lsl #16\r
2082 orr r5, r5, r5, lsl #16\r
2083 orr r6, r6, r6, lsl #16\r
2084 orr r8, r8, r8, lsl #16\r
2085 stmia r0!, {r4,r5,r6,r8}\r
2086\r
2087 and r4, lr, r7, lsl #1\r
2088 ldrh r4, [r3, r4]\r
2089 and r5, lr, r7, lsr #7\r
2090 ldrh r5, [r3, r5]\r
2091 and r6 ,lr, r7, lsr #15\r
2092 ldrh r6 ,[r3, r6]\r
2093 and r8, lr, r7, lsr #23\r
2094 ldrh r8, [r3, r8]\r
2095\r
2096 orr r4, r4, r4, lsl #16\r
2097 orr r5, r5, r5, lsl #16\r
2098 orr r6, r6, r6, lsl #16\r
2099 orr r8, r8, r8, lsl #16\r
2100 stmia r0!, {r4,r5,r6,r8}\r
2101\r
2102 subs r2, r2, #1\r
2103 bne .fl_20scale_nn\r
2104\r
52e4a905 2105 ldmfd sp!, {r4-r11,pc}\r
466fa079 2106\r
2107\r
2108.fl_20scale_bl2:\r
2109 ldr r8, [r1]\r
2110 and r8, lr, r8, lsl #1\r
2111 ldrh r8, [r3, r8]\r
2112 and r8, r8, r9\r
110a49ed 2113 mov r8, r8, lsl #16\r
466fa079 2114\r
2115.fl_20loop_bl2:\r
2116 ldr r12, [r1], #4\r
2117 ldr r7, [r1], #4\r
2118\r
2119 and r4, lr, r12, lsl #1\r
2120 ldrh r4, [r3, r4]\r
2121 and r5, lr, r12, lsr #7\r
2122 ldrh r5, [r3, r5]\r
2123 and r6, lr, r12, lsr #15\r
2124 ldrh r6, [r3, r6]\r
2125\r
2126 and r4, r4, r9\r
2127 add r10,r4, r8, lsr #16\r
2128 mov r10,r10,lsr #1\r
2129 orr r4, r10,r4, lsl #16 @ (px-1+px0)/2 | px0\r
2130\r
2131 and r8 ,lr, r12, lsr #23\r
2132 ldrh r8 ,[r3, r8]\r
2133\r
2134 and r5, r5, r9\r
2135 add r10,r5, r4, lsr #16\r
2136 mov r10,r10,lsr #1\r
2137 orr r5, r10,r5, lsl #16 @ (px0 +px1)/2 | px1\r
2138\r
2139 and r6, r6, r9\r
2140 add r10,r6, r5, lsr #16\r
2141 mov r10,r10,lsr #1\r
2142 orr r6, r10,r6, lsl #16 @ (px1 +px2)/2 | px2\r
2143\r
2144 and r8, r8, r9\r
2145 add r10,r8, r6, lsr #16\r
2146 mov r10,r10,lsr #1\r
2147 orr r8, r10,r8, lsl #16 @ (px2 +px3)/2 | px3\r
2148\r
2149 stmia r0!, {r4,r5,r6,r8}\r
2150\r
2151 and r4, lr, r7, lsl #1\r
2152 ldrh r4, [r3, r4]\r
2153 and r5, lr, r7, lsr #7\r
2154 ldrh r5, [r3, r5]\r
2155 and r6, lr, r7, lsr #15\r
2156 ldrh r6, [r3, r6]\r
2157\r
2158 and r4, r4, r9\r
2159 add r10,r4, r8, lsr #16\r
2160 mov r10,r10,lsr #1\r
2161 orr r4, r10,r4, lsl #16 @ (px-1+px0)/2 | px0\r
2162\r
2163 and r8 ,lr, r7, lsr #23\r
2164 ldrh r8 ,[r3, r8]\r
2165\r
2166 and r5, r5, r9\r
2167 add r10,r5, r4, lsr #16\r
2168 mov r10,r10,lsr #1\r
2169 orr r5, r10,r5, lsl #16 @ (px0 +px1)/2 | px1\r
2170\r
2171 and r6, r6, r9\r
2172 add r10,r6, r5, lsr #16\r
2173 mov r10,r10,lsr #1\r
2174 orr r6, r10,r6, lsl #16 @ (px1 +px2)/2 | px2\r
2175\r
2176 and r8, r8, r9\r
2177 add r10,r8, r6, lsr #16\r
2178 mov r10,r10,lsr #1\r
2179 orr r8, r10,r8, lsl #16 @ (px2 +px3)/2 | px3\r
2180\r
2181 subs r2, r2, #1\r
2182 stmia r0!, {r4,r5,r6,r8}\r
2183 bne .fl_20loop_bl2\r
3d48f143 2184\r
52e4a905 2185 ldmfd sp!, {r4-r11,pc}\r
3d48f143 2186\r
466fa079 2187\r
f62850ba 2188#ifdef UNALIGNED_DRAWLINEDEST\r
499a0be3 2189 @ unaligned versions of loops\r
9839d126 2190 @ warning: starts drawing 2bytes before dst\r
499a0be3 2191\r
2192.fl_RGB555u:\r
9839d126 2193 sub r0, r0, #2 @ initial adjustment\r
2194 mov r8, #0\r
499a0be3 2195\r
2196.fl_loopRGB555u:\r
2197 ldr r12, [r1], #4\r
2198 ldr r7, [r1], #4\r
2199\r
9839d126 2200 and r6, lr, r12,lsl #1\r
2201 ldrh r6, [r3, r6]\r
2202 and r5, lr, r12,lsr #7\r
499a0be3 2203 ldrh r5, [r3, r5]\r
9839d126 2204 orr r4, r8, r6, lsl #16\r
499a0be3 2205\r
9839d126 2206 and r6, lr, r12,lsr #15\r
499a0be3 2207 ldrh r6, [r3, r6]\r
9839d126 2208 and r8, lr, r12,lsr #23\r
499a0be3 2209 ldrh r8, [r3, r8]\r
9839d126 2210 orr r5, r5, r6, lsl #16\r
499a0be3 2211\r
9839d126 2212 and r6, lr, r7, lsl #1\r
499a0be3 2213 ldrh r6, [r3, r6]\r
9839d126 2214 and r12,lr, r7, lsr #7\r
499a0be3 2215 ldrh r12,[r3, r12]\r
9839d126 2216 orr r6, r8, r6, lsl #16\r
2217\r
2218 and r8, lr, r7, lsr #15\r
499a0be3 2219 ldrh r8, [r3, r8]\r
9839d126 2220 and r7, lr, r7, lsr #23\r
499a0be3 2221\r
2222 subs r2, r2, #1\r
9839d126 2223 orr r12,r12,r8, lsl #16\r
2224 ldrh r8, [r3, r7]\r
2225\r
2226 stmia r0!, {r4,r5,r6,r12}\r
499a0be3 2227 bne .fl_loopRGB555u\r
2228\r
2229 strh r8, [r0], #2\r
2230\r
52e4a905 2231 ldmfd sp!, {r4-r11,pc}\r
499a0be3 2232\r
2233\r
2234.fl_32scale_RGB555u:\r
9839d126 2235 sub r0, r0, #2 @ initial adjustment\r
2236 mov r4, #0\r
499a0be3 2237\r
2238 @ r9 f800 07e0 001f | e000 0780 001c | 3800 01e0 0007\r
2239.fl_loop32scale_RGB555u:\r
2240 ldr r12, [r1], #4\r
2241 ldr r7, [r1], #4\r
2242\r
9839d126 2243 and r6, lr, r12,lsl #1\r
2244 ldrh r6, [r3, r6]\r
499a0be3 2245 and r5, lr, r12,lsr #7\r
2246 ldrh r5, [r3, r5]\r
d5d17782 2247 and r6, r6, r9\r
9839d126 2248 orr r4, r4, r6, lsl #16 @ r4 = pix_d -1, 0\r
499a0be3 2249\r
d5d17782 2250 and r5, r5, r9\r
9839d126 2251 sub r8, r5, r5, lsr #2 @ r8 = 3/4 pix_s 1\r
2252 add r6, r8, r6, lsr #2 @ r6 = (1/4 pix_s 0) + (3/4 pix_s 1)\r
2253 orr r5, r6, r5, lsl #15\r
499a0be3 2254\r
2255 and r6, lr, r12,lsr #15\r
2256 ldrh r6, [r3, r6]\r
2257 and r12,lr, r12,lsr #23\r
2258 ldrh r12,[r3, r12]\r
d5d17782 2259 and r6, r6, r9\r
9839d126 2260 add r5, r5, r6, lsl #15 @ r5 = pix_d 1, 2\r
499a0be3 2261\r
9839d126 2262 and r8, lr, r7, lsl #1\r
2263 ldrh r8, [r3, r8]\r
2264 and r10,lr, r7, lsr #7\r
2265 ldrh r10,[r3, r10]\r
d5d17782 2266 and r12,r12,r9\r
9839d126 2267 sub r6, r6, r6, lsr #2 @ r6 = 3/4 pix_s 2\r
2268 add r6, r6, r12,lsr #2\r
2269 orr r6, r6, r12,lsl #16 @ r6 = pix_d 3, 4\r
499a0be3 2270\r
d5d17782 2271 and r8, r8, r9\r
2272 and r10,r10,r9\r
9839d126 2273 sub r12,r10,r10,lsr #2 @ r12 = 3/4 pix_s 5\r
2274 orr r8, r8, r8, lsl #14\r
2275 add r8, r8, r12,lsl #16 @ r8 = pix_d 5, 6\r
2276 and r12,lr, r7, lsr #15\r
499a0be3 2277 ldrh r12,[r3, r12]\r
499a0be3 2278 and r7, lr, r7, lsr #23\r
2279 ldrh r7, [r3, r7]\r
d5d17782 2280 and r12,r12,r9\r
9839d126 2281 add r10,r10,r12\r
2282 mov r10,r10, lsr #1\r
2283 sub r12,r12,r12,lsr #2 @ r12 = 3/4 pix_s 6\r
2284 orr r10,r10,r12,lsl #16\r
d5d17782 2285 and r7, r7, r9\r
9839d126 2286 add r10,r10,r7, lsl #14 @ r10 = pix_d 7, 8\r
499a0be3 2287\r
2288 subs r2, r2, #1\r
2289\r
2290 stmia r0!, {r4,r5,r6,r8,r10}\r
9839d126 2291 mov r4, r7\r
499a0be3 2292 bne .fl_loop32scale_RGB555u\r
2293\r
9839d126 2294 strh r4, [r0], #2\r
2295\r
52e4a905 2296 ldmfd sp!, {r4-r11,pc}\r
499a0be3 2297\r
f62850ba 2298#endif /* UNALIGNED_DRAWLINEDEST */\r
499a0be3 2299\r
cc68a136 2300\r
2301@ @@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@\r
2302\r
2303@ utility\r
2304.global blockcpy @ void *dst, void *src, size_t n\r
2305\r
2306blockcpy:\r
2307 stmfd sp!, {r4,r5}\r
d2e3f475 2308 cmp r0, r1\r
2309 bhs blockcpyhi\r
2310\r
96948bdf 2311 subs r2, r2, #16\r
2312 blt blockcpy2\r
cc68a136 2313blockcpy_loop:\r
2314 ldmia r1!, {r3-r5,r12}\r
96948bdf 2315 subs r2, r2, #16\r
cc68a136 2316 stmia r0!, {r3-r5,r12}\r
96948bdf 2317 bge blockcpy_loop\r
2318\r
2319blockcpy2:\r
2320 adds r2, r2, #16-4\r
2321 ldmltfd sp!, {r4,r5}\r
2322 bxlt lr\r
2323\r
2324blockcpy_loop2:\r
2325 ldr r3, [r1], #4\r
2326 subs r2, r2, #4\r
2327 str r3, [r0], #4\r
2328 bge blockcpy_loop2\r
2329\r
cc68a136 2330 ldmfd sp!, {r4,r5}\r
2331 bx lr\r
2332\r
d2e3f475 2333blockcpyhi:\r
2334 add r0, r0, r2\r
2335 add r1, r1, r2\r
96948bdf 2336\r
2337 subs r2, r2, #16\r
2338 blt blockcpyhi2\r
d2e3f475 2339blockcpyhi_loop:\r
2340 ldmdb r1!, {r3-r5,r12}\r
96948bdf 2341 subs r2, r2, #16\r
d2e3f475 2342 stmdb r0!, {r3-r5,r12}\r
96948bdf 2343 bge blockcpyhi_loop\r
2344\r
2345blockcpyhi2:\r
2346 adds r2, r2, #16-4\r
2347 ldmltfd sp!, {r4,r5}\r
2348 bxlt lr\r
2349\r
2350blockcpyhi_loop2:\r
2351 ldr r3, [r1, #-4]!\r
2352 subs r2, r2, #4\r
2353 str r3, [r0, #-4]!\r
2354 bge blockcpyhi_loop2\r
2355\r
d2e3f475 2356 ldmfd sp!, {r4,r5}\r
2357 bx lr\r
2358\r
cc68a136 2359\r
2360.global blockcpy_or @ void *dst, void *src, size_t n, int pat\r
2361\r
2362blockcpy_or:\r
2363 stmfd sp!, {r4-r6}\r
2364 orr r3, r3, r3, lsl #8\r
2365 orr r3, r3, r3, lsl #16\r
d2e3f475 2366 cmp r0, r1\r
2367 bhs blockcpyhi_or\r
2368\r
96948bdf 2369 subs r2, r2, #16\r
2370 blt blockcpy_or2\r
cc68a136 2371blockcpy_loop_or:\r
2372 ldmia r1!, {r4-r6,r12}\r
96948bdf 2373 subs r2, r2, #16\r
cc68a136 2374 orr r4, r4, r3\r
2375 orr r5, r5, r3\r
2376 orr r6, r6, r3\r
2377 orr r12,r12,r3\r
2378 stmia r0!, {r4-r6,r12}\r
96948bdf 2379 bge blockcpy_loop_or\r
2380\r
2381blockcpy_or2:\r
2382 adds r2, r2, #16-4\r
2383 ldmltfd sp!, {r4-r6}\r
2384 bxlt lr\r
2385\r
2386blockcpy_loop_or2:\r
2387 ldr r4, [r1], #4\r
2388 subs r2, r2, #4\r
2389 orr r4, r4, r3\r
2390 str r4, [r0], #4\r
2391 bge blockcpy_loop_or2\r
2392\r
cc68a136 2393 ldmfd sp!, {r4-r6}\r
2394 bx lr\r
2395\r
d2e3f475 2396blockcpyhi_or:\r
2397 add r0, r0, r2\r
2398 add r1, r1, r2\r
96948bdf 2399\r
2400 subs r2, r2, #16\r
2401 blt blockcpyhi_or2\r
d2e3f475 2402blockcpyhi_loop_or:\r
2403 ldmdb r1!, {r4-r6,r12}\r
96948bdf 2404 subs r2, r2, #16\r
d2e3f475 2405 orr r4, r4, r3\r
2406 orr r5, r5, r3\r
2407 orr r6, r6, r3\r
2408 orr r12,r12,r3\r
2409 stmdb r0!, {r4-r6,r12}\r
96948bdf 2410 bge blockcpyhi_loop_or\r
2411\r
2412blockcpyhi_or2:\r
2413 adds r2, r2, #16-4\r
2414 ldmltfd sp!, {r4-r6}\r
2415 bxlt lr\r
2416\r
2417blockcpyhi_loop_or2:\r
2418 ldr r4, [r1, #-4]!\r
2419 subs r2, r2, #4\r
2420 orr r4, r4, r3\r
2421 str r4, [r0, #-4]!\r
2422 bge blockcpyhi_loop_or2\r
2423\r
d2e3f475 2424 ldmfd sp!, {r4-r6}\r
2425 bx lr\r
2426\r
cff531af 2427@ vim:filetype=armasm\r
fast MegaDrive/MegaCD/32X emulator