Mercurial > vba-clojure
comparison src/filters/interp.h @ 27:b970226568d2
brought in filters package
author | Robert McIntyre <rlm@mit.edu> |
---|---|
date | Sun, 04 Mar 2012 20:32:31 -0600 |
parents | f9f4f1b99eed |
children |
comparison
equal
deleted
inserted
replaced
26:18eaae41bde3 | 27:b970226568d2 |
---|---|
1 /* | |
2 * This file is part of the Advance project. | |
3 * | |
4 * Copyright (C) 2003 Andrea Mazzoleni | |
5 * | |
6 * This program is free software; you can redistribute it and/or modify | |
7 * it under the terms of the GNU General Public License as published by | |
8 * the Free Software Foundation; either version 2 of the License, or | |
9 * (at your option) any later version. | |
10 * | |
11 * This program is distributed in the hope that it will be useful, | |
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 * GNU General Public License for more details. | |
15 * | |
16 * You should have received a copy of the GNU General Public License | |
17 * along with this program; if not, write to the Free Software | |
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
19 * | |
20 * In addition, as a special exception, Andrea Mazzoleni | |
21 * gives permission to link the code of this program with | |
22 * the MAME library (or with modified versions of MAME that use the | |
23 * same license as MAME), and distribute linked combinations including | |
24 * the two. You must obey the GNU General Public License in all | |
25 * respects for all of the code used other than MAME. If you modify | |
26 * this file, you may extend this exception to your version of the | |
27 * file, but you are not obligated to do so. If you do not wish to | |
28 * do so, delete this exception statement from your version. | |
29 */ | |
30 | |
31 #ifndef __INTERP_H | |
32 #define __INTERP_H | |
33 | |
34 /***************************************************************************/ | |
35 /* Basic types */ | |
36 | |
37 /***************************************************************************/ | |
38 /* interpolation */ | |
39 | |
40 extern unsigned interp_mask[2]; | |
41 extern unsigned interp_bits_per_pixel; | |
42 | |
43 #define INTERP_16_MASK_1(v) (v & interp_mask[0]) | |
44 #define INTERP_16_MASK_2(v) (v & interp_mask[1]) | |
45 | |
46 static inline u16 interp_16_521(u16 p1, u16 p2, u16 p3) | |
47 { | |
48 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*5 + INTERP_16_MASK_1(p2)*2 + INTERP_16_MASK_1(p3)*1) / 8) | |
49 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*5 + INTERP_16_MASK_2(p2)*2 + INTERP_16_MASK_2(p3)*1) / 8); | |
50 } | |
51 | |
52 static inline u16 interp_16_332(u16 p1, u16 p2, u16 p3) | |
53 { | |
54 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*3 + INTERP_16_MASK_1(p2)*3 + INTERP_16_MASK_1(p3)*2) / 8) | |
55 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*3 + INTERP_16_MASK_2(p2)*3 + INTERP_16_MASK_2(p3)*2) / 8); | |
56 } | |
57 | |
58 static inline u16 interp_16_611(u16 p1, u16 p2, u16 p3) | |
59 { | |
60 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*6 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 8) | |
61 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*6 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 8); | |
62 } | |
63 | |
64 static inline u16 interp_16_71(u16 p1, u16 p2) | |
65 { | |
66 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*7 + INTERP_16_MASK_1(p2)) / 8) | |
67 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*7 + INTERP_16_MASK_2(p2)) / 8); | |
68 } | |
69 | |
70 static inline u16 interp_16_211(u16 p1, u16 p2, u16 p3) | |
71 { | |
72 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*2 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 4) | |
73 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*2 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 4); | |
74 } | |
75 | |
76 static inline u16 interp_16_772(u16 p1, u16 p2, u16 p3) | |
77 { | |
78 return INTERP_16_MASK_1(((INTERP_16_MASK_1(p1) + INTERP_16_MASK_1(p2))*7 + INTERP_16_MASK_1(p3)*2) / 16) | |
79 | INTERP_16_MASK_2(((INTERP_16_MASK_2(p1) + INTERP_16_MASK_2(p2))*7 + INTERP_16_MASK_2(p3)*2) / 16); | |
80 } | |
81 | |
82 static inline u16 interp_16_11(u16 p1, u16 p2) | |
83 { | |
84 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1) + INTERP_16_MASK_1(p2)) / 2) | |
85 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1) + INTERP_16_MASK_2(p2)) / 2); | |
86 } | |
87 | |
88 static inline u16 interp_16_31(u16 p1, u16 p2) | |
89 { | |
90 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*3 + INTERP_16_MASK_1(p2)) / 4) | |
91 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*3 + INTERP_16_MASK_2(p2)) / 4); | |
92 } | |
93 | |
94 static inline u16 interp_16_1411(u16 p1, u16 p2, u16 p3) | |
95 { | |
96 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*14 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 16) | |
97 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*14 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 16); | |
98 } | |
99 | |
100 static inline u16 interp_16_431(u16 p1, u16 p2, u16 p3) | |
101 { | |
102 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*4 + INTERP_16_MASK_1(p2)*3 + INTERP_16_MASK_1(p3)) / 8) | |
103 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*4 + INTERP_16_MASK_2(p2)*3 + INTERP_16_MASK_2(p3)) / 8); | |
104 } | |
105 | |
106 static inline u16 interp_16_53(u16 p1, u16 p2) | |
107 { | |
108 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*5 + INTERP_16_MASK_1(p2)*3) / 8) | |
109 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*5 + INTERP_16_MASK_2(p2)*3) / 8); | |
110 } | |
111 | |
112 static inline u16 interp_16_151(u16 p1, u16 p2) | |
113 { | |
114 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*15 + INTERP_16_MASK_1(p2)) / 16) | |
115 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*15 + INTERP_16_MASK_2(p2)) / 16); | |
116 } | |
117 | |
118 static inline u16 interp_16_97(u16 p1, u16 p2) | |
119 { | |
120 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*9 + INTERP_16_MASK_1(p2)*7) / 16) | |
121 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*9 + INTERP_16_MASK_2(p2)*7) / 16); | |
122 } | |
123 | |
124 #define INTERP_32_MASK_1(v) (v & 0xFF00FF) | |
125 #define INTERP_32_MASK_2(v) (v & 0x00FF00) | |
126 | |
127 static inline u32 interp_32_521(u32 p1, u32 p2, u32 p3) | |
128 { | |
129 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*5 + INTERP_32_MASK_1(p2)*2 + INTERP_32_MASK_1(p3)*1) / 8) | |
130 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*5 + INTERP_32_MASK_2(p2)*2 + INTERP_32_MASK_2(p3)*1) / 8); | |
131 } | |
132 | |
133 static inline u32 interp_32_332(u32 p1, u32 p2, u32 p3) | |
134 { | |
135 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*3 + INTERP_32_MASK_1(p2)*3 + INTERP_32_MASK_1(p3)*2) / 8) | |
136 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*3 + INTERP_32_MASK_2(p2)*3 + INTERP_32_MASK_2(p3)*2) / 8); | |
137 } | |
138 | |
139 static inline u32 interp_32_211(u32 p1, u32 p2, u32 p3) | |
140 { | |
141 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*2 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 4) | |
142 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*2 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 4); | |
143 } | |
144 | |
145 static inline u32 interp_32_611(u32 p1, u32 p2, u32 p3) | |
146 { | |
147 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*6 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 8) | |
148 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*6 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 8); | |
149 } | |
150 | |
151 static inline u32 interp_32_71(u32 p1, u32 p2) | |
152 { | |
153 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*7 + INTERP_32_MASK_1(p2)) / 8) | |
154 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*7 + INTERP_32_MASK_2(p2)) / 8); | |
155 } | |
156 | |
157 static inline u32 interp_32_772(u32 p1, u32 p2, u32 p3) | |
158 { | |
159 return INTERP_32_MASK_1(((INTERP_32_MASK_1(p1) + INTERP_32_MASK_1(p2))*7 + INTERP_32_MASK_1(p3)*2) / 16) | |
160 | INTERP_32_MASK_2(((INTERP_32_MASK_2(p1) + INTERP_32_MASK_2(p2))*7 + INTERP_32_MASK_2(p3)*2) / 16); | |
161 } | |
162 | |
163 static inline u32 interp_32_11(u32 p1, u32 p2) | |
164 { | |
165 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1) + INTERP_32_MASK_1(p2)) / 2) | |
166 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1) + INTERP_32_MASK_2(p2)) / 2); | |
167 } | |
168 | |
169 static inline u32 interp_32_31(u32 p1, u32 p2) | |
170 { | |
171 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*3 + INTERP_32_MASK_1(p2)) / 4) | |
172 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*3 + INTERP_32_MASK_2(p2)) / 4); | |
173 } | |
174 | |
175 static inline u32 interp_32_1411(u32 p1, u32 p2, u32 p3) | |
176 { | |
177 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*14 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 16) | |
178 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*14 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 16); | |
179 } | |
180 | |
181 static inline u32 interp_32_431(u32 p1, u32 p2, u32 p3) | |
182 { | |
183 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*4 + INTERP_32_MASK_1(p2)*3 + INTERP_32_MASK_1(p3)) / 8) | |
184 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*4 + INTERP_32_MASK_2(p2)*3 + INTERP_32_MASK_2(p3)) / 8); | |
185 } | |
186 | |
187 static inline u32 interp_32_53(u32 p1, u32 p2) | |
188 { | |
189 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*5 + INTERP_32_MASK_1(p2)*3) / 8) | |
190 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*5 + INTERP_32_MASK_2(p2)*3) / 8); | |
191 } | |
192 | |
193 static inline u32 interp_32_151(u32 p1, u32 p2) | |
194 { | |
195 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*15 + INTERP_32_MASK_1(p2)) / 16) | |
196 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*15 + INTERP_32_MASK_2(p2)) / 16); | |
197 } | |
198 | |
199 static inline u32 interp_32_97(u32 p1, u32 p2) | |
200 { | |
201 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*9 + INTERP_32_MASK_1(p2)*7) / 16) | |
202 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*9 + INTERP_32_MASK_2(p2)*7) / 16); | |
203 } | |
204 | |
205 /***************************************************************************/ | |
206 /* diff */ | |
207 | |
208 #define INTERP_Y_LIMIT (0x30*4) | |
209 #define INTERP_U_LIMIT (0x07*4) | |
210 #define INTERP_V_LIMIT (0x06*8) | |
211 | |
212 static int interp_16_diff(u16 p1, u16 p2) | |
213 { | |
214 int r, g, b; | |
215 int y, u, v; | |
216 | |
217 if (p1 == p2) | |
218 return 0; | |
219 | |
220 if (interp_bits_per_pixel == 16) { | |
221 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3; | |
222 g = (int)((p1 & 0x7E0) - (p2 & 0x7E0)) >> 3; | |
223 r = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8; | |
224 } else { | |
225 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3; | |
226 g = (int)((p1 & 0x3E0) - (p2 & 0x3E0)) >> 2; | |
227 r = (int)((p1 & 0x7C00) - (p2 & 0x7C00)) >> 7; | |
228 } | |
229 | |
230 y = r + g + b; | |
231 u = r - b; | |
232 v = -r + 2*g - b; | |
233 | |
234 if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT) | |
235 return 1; | |
236 | |
237 if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT) | |
238 return 1; | |
239 | |
240 if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT) | |
241 return 1; | |
242 | |
243 return 0; | |
244 } | |
245 | |
246 static int interp_32_diff(u32 p1, u32 p2) | |
247 { | |
248 int r, g, b; | |
249 int y, u, v; | |
250 | |
251 if ((p1 & 0xF8F8F8) == (p2 & 0xF8F8F8)) | |
252 return 0; | |
253 | |
254 b = (int)((p1 & 0xFF) - (p2 & 0xFF)); | |
255 g = (int)((p1 & 0xFF00) - (p2 & 0xFF00)) >> 8; | |
256 r = (int)((p1 & 0xFF0000) - (p2 & 0xFF0000)) >> 16; | |
257 | |
258 y = r + g + b; | |
259 u = r - b; | |
260 v = -r + 2*g - b; | |
261 | |
262 if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT) | |
263 return 1; | |
264 | |
265 if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT) | |
266 return 1; | |
267 | |
268 if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT) | |
269 return 1; | |
270 | |
271 return 0; | |
272 } | |
273 | |
274 | |
275 #define INTERP_LIMIT2 (96000) | |
276 #define ABS(x) ((x) < 0 ? -(x) : (x)) | |
277 #define MAX(x,y) ((x) > (y) ? (x) : (y)) | |
278 #define MIN(x,y) ((x) < (y) ? (x) : (y)) | |
279 | |
280 static int interp_16_diff2(u16 p1, u16 p2) | |
281 { | |
282 int r, g, b; | |
283 int y, u, v; | |
284 | |
285 if ((p1 & 0xF79E) == (p2 & 0xF79E)) | |
286 return 0; | |
287 | |
288 if (interp_bits_per_pixel == 16) { | |
289 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3; | |
290 g = (int)((p1 & 0x7E0) - (p2 & 0x7E0)) >> 3; | |
291 r = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8; | |
292 } else { | |
293 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3; | |
294 g = (int)((p1 & 0x3E0) - (p2 & 0x3E0)) >> 2; | |
295 r = (int)((p1 & 0x7C00) - (p2 & 0x7C00)) >> 7; | |
296 } | |
297 | |
298 // yb = 30*r + 58*g + 12*b; | |
299 y = 33*r + 36*g + 31*b; | |
300 u = -14*r - 29*g + 44*b; | |
301 v = 62*r - 51*g - 10*b; | |
302 | |
303 if (11*ABS(y) + 8*ABS(u) + 6*ABS(v) > INTERP_LIMIT2) | |
304 return 1; | |
305 return 0; | |
306 } | |
307 | |
308 static int interp_32_diff2(u32 p1, u32 p2) | |
309 { | |
310 int r, g, b; | |
311 int y, u, v; | |
312 | |
313 if ((p1 & 0xF0F0F0) == (p2 & 0xF0F0F0)) | |
314 return 0; | |
315 | |
316 b = (int)((p1 & 0xF8) - (p2 & 0xF8)); | |
317 g = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8; | |
318 r = (int)((p1 & 0xF80000) - (p2 & 0xF80000)) >> 16; | |
319 | |
320 // y = 30*r + 58*g + 12*b; | |
321 y = 33*r + 36*g + 31*b; | |
322 u = -14*r - 29*g + 44*b; | |
323 v = 62*r - 51*g - 10*b; | |
324 | |
325 if (11*ABS(y) + 8*ABS(u) + 6*ABS(v) > INTERP_LIMIT2) | |
326 return 1; | |
327 | |
328 return 0; | |
329 } | |
330 | |
331 static void interp_set(unsigned bits_per_pixel) | |
332 { | |
333 interp_bits_per_pixel = bits_per_pixel; | |
334 | |
335 switch (bits_per_pixel) { | |
336 case 15 : | |
337 interp_mask[0] = 0x7C1F; | |
338 interp_mask[1] = 0x03E0; | |
339 break; | |
340 case 16 : | |
341 interp_mask[0] = 0xF81F; | |
342 interp_mask[1] = 0x07E0; | |
343 break; | |
344 case 32 : | |
345 interp_mask[0] = 0xFF00FF; | |
346 interp_mask[1] = 0x00FF00; | |
347 break; | |
348 } | |
349 } | |
350 | |
351 #endif |