1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
|
@ ScummVM - Graphic Adventure Engine
@
@ ScummVM is the legal property of its developers, whose names
@ are too numerous to list here. Please refer to the COPYRIGHT
@ file distributed with this source distribution.
@
@ This program is free software@ you can redistribute it and/or
@ modify it under the terms of the GNU General Public License
@ as published by the Free Software Foundation@ either version 2
@ of the License, or (at your option) any later version.
@
@ This program is distributed in the hope that it will be useful,
@ but WITHOUT ANY WARRANTY@ without even the implied warranty of
@ MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
@ GNU General Public License for more details.
@
@ You should have received a copy of the GNU General Public License
@ along with this program@ if not, write to the Free Software
@ Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
@
@ @author Robin Watts (robin@wss.co.uk)
.text
.global Normal2xARM
.global Normal2xAspectMask
@ Assumes dst is aligned (so did the C)
@ Assumes 16bit (so did the C)
Normal2xARM:
@ r0 = src
@ r1 = srcPitch
@ r2 = dst
@ r3 = dstPitch
@ r4 = w
@ r5 = h
STMFD r13!,{r4-r11,r14}
LDR r4, [r13,#4*9] @ r4 = w
LDR r5, [r13,#4*10] @ r5 = h
ADD r12,r2, r3
SUB r1, r1, r4, LSL #1
SUB r6, r3, r4, LSL #2
ADD r3, r3, r6
yloop:
SUBS r14,r4, #4
ADDLT r14,r14, #4
BLT thin
xloop:
LDRH r6, [r0], #2
LDRH r7, [r0], #2
LDRH r8, [r0], #2
LDRH r9, [r0], #2
ORR r6, r6, r6, LSL #16
ORR r7, r7, r7, LSL #16
ORR r8, r8, r8, LSL #16
ORR r9, r9, r9, LSL #16
STMIA r2!, {r6-r9}
STMIA r12!,{r6-r9}
SUBS r14,r14,#4
BGE xloop
ADDS r14,r14,#4
BNE thin
ADD r0, r0, r1
ADD r2, r2, r3
ADD r12,r12,r3
SUBS r5, r5, #1
BGT yloop
LDMFD r13!,{r4-r11,PC}
thin:
LDRH r6, [r0], #2
ORR r6, r6, r6, LSL #16
STR r6, [r2], #4
STR r6, [r12],#4
SUBS r14,r14,#1
BGT thin
ADD r0, r0, r1
ADD r2, r2, r3
ADD r12,r12,r3
SUBS r5, r5, #1
BGT yloop
LDMFD r13!,{r4-r11,PC}
@ Horrid filter calculations
@ AAAAAAAAAAAABBBBBBBBBBBBCCCCCCCCCCCCDDDDDDDDDDDDEEEEEEEEEEEE
@ <-+-><-+-><-+-><-+-><-+-><-+-><-+-><-+-><-+-><-+-><-+-><-+->
@ Ideal: A,A,(A*2+B*3)/5,B,(B*4+C)/5,C,C,(C+D*4)/5,D,(D*3+E*2)/5,E,E
@ Actual: A,A,(A*3+B*5)/8,B,(B*7+C)/8,C,C,(C+D*7)/8,D,(D*5+E*3)/8,E,E
@ Assumes dst is aligned (so did the C)
@ Assumes 16bit (so did the C)
Normal2xAspectMask:
@ r0 = src
@ r1 = srcPitch
@ r2 = dst
@ r3 = dstPitch
@ r4 = w
@ r5 = h
@ r12= mask
STMFD r13!,{r4-r11,r14}
LDR r4, [r13,#4*9] @ r4 = w
LDR r5, [r13,#4*10] @ r5 = h
LDR r12,[r13,#4*11] @ r12= mask
MOV r11,#2
SUB r11,r11,r1, LSL #2 @ r11= 2-srcPitch*4
MOV r14,#4
SUB r14,r14,r3, LSL #3
SUB r14,r14,r3, LSL #1
SUB r14,r14,r3 @ r14 = 4-dstPitch*11
SUBS r5, r5, #4
BLE last_few_lines
yloop_aspect:
xloop_aspect:
LDRH r6, [r0], r1 @ r6 = A
LDRH r7, [r0], r1 @ r7 = B
LDRH r8, [r0], r1 @ r8 = C
LDRH r9, [r0], r1 @ r9 = D
LDRH r10,[r0], r11 @ r10= E
ORR r6, r6, r6, LSL #16 @ r6 = output 0, 1
ORR r7, r7, r7, LSL #16 @ r7 = output 3
ORR r8, r8, r8, LSL #16 @ r8 = output 5,6
ORR r9, r9, r9, LSL #16 @ r9 = output 8
ORR r10,r10,r10,LSL #16 @ r10= output 10, 11
STR r6, [r2], r3 @ output 0 (A)
STR r6, [r2], r3 @ output 1 (A)
AND r6, r6, r12 @ r6 = A split
ADD r6, r6, r6, LSL #1 @ r6 = A*3
STR r7, [r2, r3] @ output 3 (B)
AND r7, r7, r12 @ r7 = B split
ADD r6, r6, r7 @ r6 = A*3 + B
ADD r6, r6, r7, LSL #2 @ r6 = A*3 + B*5
AND r6, r12,r6, LSR #3 @ r6 = (A*3 + B*5)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 2
STR r6, [r2], r3, LSL #1 @ output 2 (A*3+B*5)>>3
RSB r7, r7, r7, LSL #3 @ r7 = B*7
AND r6, r8, r12 @ r6 = C split
ADD r7, r7, r6 @ r7 = B*7+C
AND r7, r12,r7, LSR #3 @ r7 = (B*7 + C)>>3
ORR r7, r7, r7, ROR #16 @ r7 = output 4
STR r7, [r2], r3 @ output 4 (B*7+C)>>3
STR r8, [r2], r3 @ output 5 (C)
STR r8, [r2], r3 @ output 6 (C)
STR r9, [r2, r3] @ output 8 (D)
AND r9, r9, r12 @ r9 = D split
RSB r7, r9, r9, LSL #3 @ r7 = D*7
ADD r6, r6, r7 @ r6 = C+D*7
AND r6, r12,r6, LSR #3 @ r6 = (C + D*7)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 7
STR r6, [r2], r3, LSL #1 @ output 7 (C+D*7)>>3
ADD r9, r9, r9, LSL #2 @ r9 = D*5
AND r6, r10,r12 @ r6 = E split
ADD r9, r9, r6 @ r9 = D*5+E
ADD r9, r9, r6, LSL #1 @ r9 = D*5+E*3
AND r9, r12,r9, LSR #3 @ r9 = (D*5 + E*3)>>3
ORR r9, r9, r9, ROR #16 @ r9 = output 9
STR r9, [r2], r3 @ output 9 (D*5+E*3)>>3
STR r10,[r2], r3 @ output 10 (E)
STR r10,[r2], r14 @ output 11 (E)
SUBS r4, r4, #1
BGT xloop_aspect
LDR r4, [r13,#4*9] @ r4 = w
ADD r0, r0, r1, LSL #2
ADD r0, r0, r1
SUB r0, r0, r4, LSL #1
ADD r2, r2, r3, LSL #3
ADD r2, r2, r3, LSL #2
SUB r2, r2, r4, LSL #2
SUBS r5, r5, #5
BGT yloop_aspect
last_few_lines:
@ r5 = -4 => done, -3 => 1 left, -2 = 2 left, -1 = 3 left, 0 = 4 left
ADDS r5, r5, #3
@ r5 = -1 => done, 0 => 1 left, 1 = 2 left, 2 = 3 left, 3 = 4 left
LDMLTFD r13!,{r4-r11,PC}
BEQ last1lines
CMP r5, #2
BEQ last3lines
BGT last4lines
last2lines:
ADD r11,r11,r1
ADD r14,r14,r3
ADD r11,r11,r1, LSL #1
ADD r14,r14,r3, LSL #3
xloop_aspect2:
LDRH r6, [r0], r1 @ r6 = A
LDRH r7, [r0], r11 @ r7 = B
SUBS r4, r4, #1
ORR r6, r6, r6, LSL #16 @ r6 = output 0, 1
ORR r7, r7, r7, LSL #16 @ r7 = output 3
STR r6, [r2], r3 @ output 0 (A)
STR r6, [r2], r3 @ output 1 (A)
AND r6, r6, r12 @ r6 = A split
ADD r6, r6, r6, LSL #1 @ r6 = A*3
STR r7, [r2, r3] @ output 3 (B)
AND r7, r7, r12 @ r7 = B split
ADD r6, r6, r7 @ r6 = A*3 + B
ADD r6, r6, r7, LSL #2 @ r6 = A*3 + B*5
AND r6, r12,r6, LSR #3 @ r6 = (A*3 + B*5)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 2
STR r6, [r2], r14 @ output 2 (A*3+B*5)>>3
BGT xloop_aspect2
LDMFD r13!,{r4-r11,PC}
last1lines:
xloop_aspect1:
LDRH r6, [r0], #2 @ r6 = A
ORR r6, r6, r6, LSL #16 @ r6 = output 0, 1
STR r6, [r2, r3] @ output 0 (A)
STR r6, [r2], #4 @ output 1 (A)
SUBS r4, r4, #1
BGT xloop_aspect1
LDMFD r13!,{r4-r11,PC}
last3lines:
ADD r14,r14,r3, LSL #2
ADD r11,r11,r1
xloop_aspect3:
LDRH r6, [r0], r1 @ r6 = A
LDRH r7, [r0], r1 @ r7 = B
LDRH r8, [r0], r1 @ r8 = C
LDRH r9, [r0], r11 @ r9 = D
ORR r6, r6, r6, LSL #16 @ r6 = output 0, 1
ORR r7, r7, r7, LSL #16 @ r7 = output 3
ORR r8, r8, r8, LSL #16 @ r8 = output 5,6
ORR r9, r9, r9, LSL #16 @ r9 = output 8
STR r6, [r2], r3 @ output 0 (A)
STR r6, [r2], r3 @ output 1 (A)
AND r6, r6, r12 @ r6 = A split
ADD r6, r6, r6, LSL #1 @ r6 = A*3
STR r7, [r2, r3] @ output 3 (B)
AND r7, r7, r12 @ r7 = B split
ADD r6, r6, r7 @ r6 = A*3 + B
ADD r6, r6, r7, LSL #2 @ r6 = A*3 + B*5
AND r6, r12,r6, LSR #3 @ r6 = (A*3 + B*5)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 2
STR r6, [r2], r3, LSL #1 @ output 2 (A*3+B*5)>>3
RSB r7, r7, r7, LSL #3 @ r7 = B*7
AND r6, r8, r12 @ r6 = C split
ADD r7, r7, r6 @ r7 = B*7+C
AND r7, r12,r7, LSR #3 @ r7 = (B*7 + C)>>3
ORR r7, r7, r7, ROR #16 @ r7 = output 4
STR r7, [r2], r3 @ output 4 (B*7+C)>>3
STR r8, [r2], r3 @ output 5 (C)
STR r8, [r2], r3 @ output 6 (C)
AND r9, r9, r12 @ r9 = D split
RSB r7, r9, r9, LSL #3 @ r7 = D*7
ADD r6, r6, r7 @ r6 = C+D*7
AND r6, r12,r6, LSR #3 @ r6 = (C + D*7)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 7
STR r6, [r2], r14 @ output 7 (C+D*7)>>3
SUBS r4, r4, #1
BGT xloop_aspect3
LDMFD r13!,{r4-r11,PC}
last4lines:
ADD r14,r14,r3, LSL #1
xloop_aspect4:
LDRH r6, [r0], r1 @ r6 = A
LDRH r7, [r0], r1 @ r7 = B
LDRH r8, [r0], r1 @ r8 = C
LDRH r9, [r0], r1 @ r9 = D
LDRH r10,[r0], r11 @ r10= E
ORR r6, r6, r6, LSL #16 @ r6 = output 0, 1
ORR r7, r7, r7, LSL #16 @ r7 = output 3
ORR r8, r8, r8, LSL #16 @ r8 = output 5,6
ORR r9, r9, r9, LSL #16 @ r9 = output 8
ORR r10,r10,r10,LSL #16 @ r10= output 10, 11
STR r6, [r2], r3 @ output 0 (A)
STR r6, [r2], r3 @ output 1 (A)
AND r6, r6, r12 @ r6 = A split
ADD r6, r6, r6, LSL #1 @ r6 = A*3
STR r7, [r2, r3] @ output 3 (B)
AND r7, r7, r12 @ r7 = B split
ADD r6, r6, r7 @ r6 = A*3 + B
ADD r6, r6, r7, LSL #2 @ r6 = A*3 + B*5
AND r6, r12,r6, LSR #3 @ r6 = (A*3 + B*5)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 2
STR r6, [r2], r3, LSL #1 @ output 2 (A*3+B*5)>>3
RSB r7, r7, r7, LSL #3 @ r7 = B*7
AND r6, r8, r12 @ r6 = C split
ADD r7, r7, r6 @ r7 = B*7+C
AND r7, r12,r7, LSR #3 @ r7 = (B*7 + C)>>3
ORR r7, r7, r7, ROR #16 @ r7 = output 4
STR r7, [r2], r3 @ output 4 (B*7+C)>>3
STR r8, [r2], r3 @ output 5 (C)
STR r8, [r2], r3 @ output 6 (C)
STR r9, [r2, r3] @ output 8 (D)
AND r9, r9, r12 @ r9 = D split
RSB r7, r9, r9, LSL #3 @ r7 = D*7
ADD r6, r6, r7 @ r6 = C+D*7
AND r6, r12,r6, LSR #3 @ r6 = (C + D*7)>>3
ORR r6, r6, r6, ROR #16 @ r6 = output 7
STR r6, [r2], r3, LSL #1 @ output 7 (C+D*7)>>3
ADD r9, r9, r9, LSL #2 @ r9 = D*5
AND r6, r10,r12 @ r6 = E split
ADD r9, r9, r6 @ r9 = D*5+E
ADD r9, r9, r6, LSL #1 @ r9 = D*5+E*3
AND r9, r12,r9, LSR #3 @ r9 = (D*5 + E*3)>>3
ORR r9, r9, r9, ROR #16 @ r9 = output 9
STR r9, [r2], r14 @ output 9 (D*5+E*3)>>3
SUBS r4, r4, #1
BGT xloop_aspect4
LDMFD r13!,{r4-r11,PC}
|
