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 typedef unsigned char u8;
35 typedef unsigned short u16;
36 typedef unsigned int u32;
37
38 /***************************************************************************/
39 /* Basic types */
40
41 /***************************************************************************/
42 /* interpolation */
43
44 extern unsigned interp_mask[2];
45 extern unsigned interp_bits_per_pixel;
46
47 #define INTERP_16_MASK_1(v) (v & interp_mask[0])
48 #define INTERP_16_MASK_2(v) (v & interp_mask[1])
49
interp_16_521(u16 p1,u16 p2,u16 p3)50 static inline u16 interp_16_521(u16 p1, u16 p2, u16 p3)
51 {
52 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*5 + INTERP_16_MASK_1(p2)*2 + INTERP_16_MASK_1(p3)*1) / 8)
53 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*5 + INTERP_16_MASK_2(p2)*2 + INTERP_16_MASK_2(p3)*1) / 8);
54 }
55
interp_16_332(u16 p1,u16 p2,u16 p3)56 static inline u16 interp_16_332(u16 p1, u16 p2, u16 p3)
57 {
58 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*3 + INTERP_16_MASK_1(p2)*3 + INTERP_16_MASK_1(p3)*2) / 8)
59 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*3 + INTERP_16_MASK_2(p2)*3 + INTERP_16_MASK_2(p3)*2) / 8);
60 }
61
interp_16_611(u16 p1,u16 p2,u16 p3)62 static inline u16 interp_16_611(u16 p1, u16 p2, u16 p3)
63 {
64 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*6 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 8)
65 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*6 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 8);
66 }
67
interp_16_71(u16 p1,u16 p2)68 static inline u16 interp_16_71(u16 p1, u16 p2)
69 {
70 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*7 + INTERP_16_MASK_1(p2)) / 8)
71 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*7 + INTERP_16_MASK_2(p2)) / 8);
72 }
73
interp_16_211(u16 p1,u16 p2,u16 p3)74 static inline u16 interp_16_211(u16 p1, u16 p2, u16 p3)
75 {
76 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*2 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 4)
77 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*2 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 4);
78 }
79
interp_16_772(u16 p1,u16 p2,u16 p3)80 static inline u16 interp_16_772(u16 p1, u16 p2, u16 p3)
81 {
82 return INTERP_16_MASK_1(((INTERP_16_MASK_1(p1) + INTERP_16_MASK_1(p2))*7 + INTERP_16_MASK_1(p3)*2) / 16)
83 | INTERP_16_MASK_2(((INTERP_16_MASK_2(p1) + INTERP_16_MASK_2(p2))*7 + INTERP_16_MASK_2(p3)*2) / 16);
84 }
85
interp_16_11(u16 p1,u16 p2)86 static inline u16 interp_16_11(u16 p1, u16 p2)
87 {
88 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1) + INTERP_16_MASK_1(p2)) / 2)
89 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1) + INTERP_16_MASK_2(p2)) / 2);
90 }
91
interp_16_31(u16 p1,u16 p2)92 static u16 interp_16_31(u16 p1, u16 p2)
93 {
94 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*3 + INTERP_16_MASK_1(p2)) / 4)
95 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*3 + INTERP_16_MASK_2(p2)) / 4);
96 }
97
interp_16_1411(u16 p1,u16 p2,u16 p3)98 static inline u16 interp_16_1411(u16 p1, u16 p2, u16 p3)
99 {
100 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*14 + INTERP_16_MASK_1(p2) + INTERP_16_MASK_1(p3)) / 16)
101 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*14 + INTERP_16_MASK_2(p2) + INTERP_16_MASK_2(p3)) / 16);
102 }
103
interp_16_431(u16 p1,u16 p2,u16 p3)104 static inline u16 interp_16_431(u16 p1, u16 p2, u16 p3)
105 {
106 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*4 + INTERP_16_MASK_1(p2)*3 + INTERP_16_MASK_1(p3)) / 8)
107 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*4 + INTERP_16_MASK_2(p2)*3 + INTERP_16_MASK_2(p3)) / 8);
108 }
109
interp_16_53(u16 p1,u16 p2)110 static inline u16 interp_16_53(u16 p1, u16 p2)
111 {
112 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*5 + INTERP_16_MASK_1(p2)*3) / 8)
113 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*5 + INTERP_16_MASK_2(p2)*3) / 8);
114 }
115
interp_16_151(u16 p1,u16 p2)116 static inline u16 interp_16_151(u16 p1, u16 p2)
117 {
118 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*15 + INTERP_16_MASK_1(p2)) / 16)
119 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*15 + INTERP_16_MASK_2(p2)) / 16);
120 }
121
interp_16_97(u16 p1,u16 p2)122 static inline u16 interp_16_97(u16 p1, u16 p2)
123 {
124 return INTERP_16_MASK_1((INTERP_16_MASK_1(p1)*9 + INTERP_16_MASK_1(p2)*7) / 16)
125 | INTERP_16_MASK_2((INTERP_16_MASK_2(p1)*9 + INTERP_16_MASK_2(p2)*7) / 16);
126 }
127
128 #define INTERP_32_MASK_1(v) (v & 0xFF00FF)
129 #define INTERP_32_MASK_2(v) (v & 0x00FF00)
130
interp_32_521(u32 p1,u32 p2,u32 p3)131 static inline u32 interp_32_521(u32 p1, u32 p2, u32 p3)
132 {
133 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*5 + INTERP_32_MASK_1(p2)*2 + INTERP_32_MASK_1(p3)*1) / 8)
134 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*5 + INTERP_32_MASK_2(p2)*2 + INTERP_32_MASK_2(p3)*1) / 8);
135 }
136
interp_32_332(u32 p1,u32 p2,u32 p3)137 static inline u32 interp_32_332(u32 p1, u32 p2, u32 p3)
138 {
139 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*3 + INTERP_32_MASK_1(p2)*3 + INTERP_32_MASK_1(p3)*2) / 8)
140 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*3 + INTERP_32_MASK_2(p2)*3 + INTERP_32_MASK_2(p3)*2) / 8);
141 }
142
interp_32_211(u32 p1,u32 p2,u32 p3)143 static inline u32 interp_32_211(u32 p1, u32 p2, u32 p3)
144 {
145 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*2 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 4)
146 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*2 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 4);
147 }
148
interp_32_611(u32 p1,u32 p2,u32 p3)149 static inline u32 interp_32_611(u32 p1, u32 p2, u32 p3)
150 {
151 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*6 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 8)
152 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*6 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 8);
153 }
154
interp_32_71(u32 p1,u32 p2)155 static inline u32 interp_32_71(u32 p1, u32 p2)
156 {
157 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*7 + INTERP_32_MASK_1(p2)) / 8)
158 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*7 + INTERP_32_MASK_2(p2)) / 8);
159 }
160
interp_32_772(u32 p1,u32 p2,u32 p3)161 static inline u32 interp_32_772(u32 p1, u32 p2, u32 p3)
162 {
163 return INTERP_32_MASK_1(((INTERP_32_MASK_1(p1) + INTERP_32_MASK_1(p2))*7 + INTERP_32_MASK_1(p3)*2) / 16)
164 | INTERP_32_MASK_2(((INTERP_32_MASK_2(p1) + INTERP_32_MASK_2(p2))*7 + INTERP_32_MASK_2(p3)*2) / 16);
165 }
166
interp_32_11(u32 p1,u32 p2)167 static inline u32 interp_32_11(u32 p1, u32 p2)
168 {
169 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1) + INTERP_32_MASK_1(p2)) / 2)
170 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1) + INTERP_32_MASK_2(p2)) / 2);
171 }
172
interp_32_31(u32 p1,u32 p2)173 static u32 interp_32_31(u32 p1, u32 p2)
174 {
175 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*3 + INTERP_32_MASK_1(p2)) / 4)
176 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*3 + INTERP_32_MASK_2(p2)) / 4);
177 }
178
interp_32_1411(u32 p1,u32 p2,u32 p3)179 static inline u32 interp_32_1411(u32 p1, u32 p2, u32 p3)
180 {
181 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*14 + INTERP_32_MASK_1(p2) + INTERP_32_MASK_1(p3)) / 16)
182 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*14 + INTERP_32_MASK_2(p2) + INTERP_32_MASK_2(p3)) / 16);
183 }
184
interp_32_431(u32 p1,u32 p2,u32 p3)185 static inline u32 interp_32_431(u32 p1, u32 p2, u32 p3)
186 {
187 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*4 + INTERP_32_MASK_1(p2)*3 + INTERP_32_MASK_1(p3)) / 8)
188 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*4 + INTERP_32_MASK_2(p2)*3 + INTERP_32_MASK_2(p3)) / 8);
189 }
190
interp_32_53(u32 p1,u32 p2)191 static inline u32 interp_32_53(u32 p1, u32 p2)
192 {
193 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*5 + INTERP_32_MASK_1(p2)*3) / 8)
194 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*5 + INTERP_32_MASK_2(p2)*3) / 8);
195 }
196
interp_32_151(u32 p1,u32 p2)197 static inline u32 interp_32_151(u32 p1, u32 p2)
198 {
199 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*15 + INTERP_32_MASK_1(p2)) / 16)
200 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*15 + INTERP_32_MASK_2(p2)) / 16);
201 }
202
interp_32_97(u32 p1,u32 p2)203 static inline u32 interp_32_97(u32 p1, u32 p2)
204 {
205 return INTERP_32_MASK_1((INTERP_32_MASK_1(p1)*9 + INTERP_32_MASK_1(p2)*7) / 16)
206 | INTERP_32_MASK_2((INTERP_32_MASK_2(p1)*9 + INTERP_32_MASK_2(p2)*7) / 16);
207 }
208
209 /***************************************************************************/
210 /* diff */
211 /*
212 #define INTERP_Y_LIMIT (0x30*4)
213 #define INTERP_U_LIMIT (0x07*4)
214 #define INTERP_V_LIMIT (0x06*8)
215
216 static int interp_16_diff(u16 p1, u16 p2)
217 {
218 int r, g, b;
219 int y, u, v;
220
221 if (p1 == p2)
222 return 0;
223
224 if (interp_bits_per_pixel == 16) {
225 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3;
226 g = (int)((p1 & 0x7E0) - (p2 & 0x7E0)) >> 3;
227 r = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8;
228 } else {
229 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3;
230 g = (int)((p1 & 0x3E0) - (p2 & 0x3E0)) >> 2;
231 r = (int)((p1 & 0x7C00) - (p2 & 0x7C00)) >> 7;
232 }
233
234 y = r + g + b;
235 u = r - b;
236 v = -r + 2*g - b;
237
238 if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT)
239 return 1;
240
241 if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT)
242 return 1;
243
244 if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT)
245 return 1;
246
247 return 0;
248 }
249
250 static int interp_32_diff(u32 p1, u32 p2)
251 {
252 int r, g, b;
253 int y, u, v;
254
255 if ((p1 & 0xF8F8F8) == (p2 & 0xF8F8F8))
256 return 0;
257
258 b = (int)((p1 & 0xFF) - (p2 & 0xFF));
259 g = (int)((p1 & 0xFF00) - (p2 & 0xFF00)) >> 8;
260 r = (int)((p1 & 0xFF0000) - (p2 & 0xFF0000)) >> 16;
261
262 y = r + g + b;
263 u = r - b;
264 v = -r + 2*g - b;
265
266 if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT)
267 return 1;
268
269 if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT)
270 return 1;
271
272 if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT)
273 return 1;
274
275 return 0;
276 }
277
278
279 #define INTERP_LIMIT2 (96000)
280 #define ABS(x) ((x) < 0 ? -(x) : (x))
281 #define MAX(x,y) ((x) > (y) ? (x) : (y))
282 #define MIN(x,y) ((x) < (y) ? (x) : (y))
283
284 static int interp_16_diff2(u16 p1, u16 p2)
285 {
286 int r, g, b;
287 int y, u, v;
288
289 if ((p1 & 0xF79E) == (p2 & 0xF79E))
290 return 0;
291
292 if (interp_bits_per_pixel == 16) {
293 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3;
294 g = (int)((p1 & 0x7E0) - (p2 & 0x7E0)) >> 3;
295 r = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8;
296 } else {
297 b = (int)((p1 & 0x1F) - (p2 & 0x1F)) << 3;
298 g = (int)((p1 & 0x3E0) - (p2 & 0x3E0)) >> 2;
299 r = (int)((p1 & 0x7C00) - (p2 & 0x7C00)) >> 7;
300 }
301
302 // yb = 30*r + 58*g + 12*b;
303 y = 33*r + 36*g + 31*b;
304 u = -14*r - 29*g + 44*b;
305 v = 62*r - 51*g - 10*b;
306
307 if (11*ABS(y) + 8*ABS(u) + 6*ABS(v) > INTERP_LIMIT2)
308 return 1;
309 return 0;
310 }
311
312 static int interp_32_diff2(u32 p1, u32 p2)
313 {
314 int r, g, b;
315 int y, u, v;
316
317 if ((p1 & 0xF0F0F0) == (p2 & 0xF0F0F0))
318 return 0;
319
320 b = (int)((p1 & 0xF8) - (p2 & 0xF8));
321 g = (int)((p1 & 0xF800) - (p2 & 0xF800)) >> 8;
322 r = (int)((p1 & 0xF80000) - (p2 & 0xF80000)) >> 16;
323
324 // y = 30*r + 58*g + 12*b;
325 y = 33*r + 36*g + 31*b;
326 u = -14*r - 29*g + 44*b;
327 v = 62*r - 51*g - 10*b;
328
329 if (11*ABS(y) + 8*ABS(u) + 6*ABS(v) > INTERP_LIMIT2)
330 return 1;
331
332 return 0;
333 }
334 */
interp_set(unsigned bits_per_pixel)335 static void interp_set(unsigned bits_per_pixel)
336 {
337 interp_bits_per_pixel = bits_per_pixel;
338
339 switch (bits_per_pixel) {
340 case 15 :
341 interp_mask[0] = 0x7C1F;
342 interp_mask[1] = 0x03E0;
343 break;
344 case 16 :
345 interp_mask[0] = 0xF81F;
346 interp_mask[1] = 0x07E0;
347 break;
348 case 32 :
349 interp_mask[0] = 0xFF00FF;
350 interp_mask[1] = 0x00FF00;
351 break;
352 }
353 }
354
355 #endif
356