view src/filters/2xSaI.cpp @ 515:f68d600b089c

colors now work properly.
author Robert McIntyre <rlm@mit.edu>
date Fri, 22 Jun 2012 21:21:48 -0500
parents f9f4f1b99eed
children
line wrap: on
line source
1 #include "../common/System.h"
3 extern "C"
4 {
5 #ifdef MMX
6 void _2xSaILine(u8 *srcPtr, u8 *deltaPtr, u32 srcPitch,
7 u32 width, u8 *dstPtr, u32 dstPitch);
8 void _2xSaISuperEagleLine(u8 *srcPtr, u8 *deltaPtr,
9 u32 srcPitch, u32 width,
10 u8 *dstPtr, u32 dstPitch);
11 void _2xSaISuper2xSaILine(u8 *srcPtr, u8 *deltaPtr,
12 u32 srcPitch, u32 width,
13 u8 *dstPtr, u32 dstPitch);
14 void Init_2xSaIMMX(u32 BitFormat);
15 void BilinearMMX(u16 *A, u16 *B, u16 *C, u16 *D,
16 u16 *dx, u16 *dy, u8 *dP);
17 void BilinearMMXGrid0(u16 *A, u16 *B, u16 *C, u16 *D,
18 u16 *dx, u16 *dy, u8 *dP);
19 void BilinearMMXGrid1(u16 *A, u16 *B, u16 *C, u16 *D,
20 u16 *dx, u16 *dy, u8 *dP);
21 void EndMMX();
23 bool cpu_mmx = 1;
24 #endif
25 }
26 static u32 colorMask = 0xF7DEF7DE;
27 static u32 lowPixelMask = 0x08210821;
28 static u32 qcolorMask = 0xE79CE79C;
29 static u32 qlowpixelMask = 0x18631863;
30 static u32 redblueMask = 0xF81F;
31 static u32 greenMask = 0x7E0;
33 u32 qRGB_COLOR_MASK[2] = { 0xF7DEF7DE, 0xF7DEF7DE };
35 extern void hq2x_init(unsigned);
37 int Init_2xSaI(u32 BitFormat)
38 {
39 if (systemColorDepth == 16)
40 {
41 if (BitFormat == 565)
42 {
43 colorMask = 0xF7DEF7DE;
44 lowPixelMask = 0x08210821;
45 qcolorMask = 0xE79CE79C;
46 qlowpixelMask = 0x18631863;
47 redblueMask = 0xF81F;
48 greenMask = 0x7E0;
49 qRGB_COLOR_MASK[0] = qRGB_COLOR_MASK[1] = 0xF7DEF7DE;
50 hq2x_init(16);
51 }
52 else if (BitFormat == 555)
53 {
54 colorMask = 0x7BDE7BDE;
55 lowPixelMask = 0x04210421;
56 qcolorMask = 0x739C739C;
57 qlowpixelMask = 0x0C630C63;
58 redblueMask = 0x7C1F;
59 greenMask = 0x3E0;
60 qRGB_COLOR_MASK[0] = qRGB_COLOR_MASK[1] = 0x7BDE7BDE;
61 hq2x_init(15);
62 }
63 else
64 {
65 return 0;
66 }
67 }
68 else if (systemColorDepth == 32)
69 {
70 colorMask = 0xfefefe;
71 lowPixelMask = 0x010101;
72 qcolorMask = 0xfcfcfc;
73 qlowpixelMask = 0x030303;
74 qRGB_COLOR_MASK[0] = qRGB_COLOR_MASK[1] = 0xfefefe;
75 hq2x_init(32);
76 }
77 else
78 return 0;
80 #ifdef MMX
81 Init_2xSaIMMX(BitFormat);
82 #endif
84 return 1;
85 }
87 static inline int GetResult1(u32 A, u32 B, u32 C, u32 D,
88 u32 /* E */)
89 {
90 int x = 0;
91 int y = 0;
92 int r = 0;
94 if (A == C)
95 x += 1;
96 else if (B == C)
97 y += 1;
98 if (A == D)
99 x += 1;
100 else if (B == D)
101 y += 1;
102 if (x <= 1)
103 r += 1;
104 if (y <= 1)
105 r -= 1;
106 return r;
107 }
109 static inline int GetResult2(u32 A, u32 B, u32 C, u32 D,
110 u32 /* E */)
111 {
112 int x = 0;
113 int y = 0;
114 int r = 0;
116 if (A == C)
117 x += 1;
118 else if (B == C)
119 y += 1;
120 if (A == D)
121 x += 1;
122 else if (B == D)
123 y += 1;
124 if (x <= 1)
125 r -= 1;
126 if (y <= 1)
127 r += 1;
128 return r;
129 }
131 static inline int GetResult(u32 A, u32 B, u32 C, u32 D)
132 {
133 int x = 0;
134 int y = 0;
135 int r = 0;
137 if (A == C)
138 x += 1;
139 else if (B == C)
140 y += 1;
141 if (A == D)
142 x += 1;
143 else if (B == D)
144 y += 1;
145 if (x <= 1)
146 r += 1;
147 if (y <= 1)
148 r -= 1;
149 return r;
150 }
152 static inline u32 INTERPOLATE(u32 A, u32 B)
153 {
154 if (A != B)
155 {
156 return (((A & colorMask) >> 1) + ((B & colorMask) >> 1) +
157 (A & B & lowPixelMask));
158 }
159 else
160 return A;
161 }
163 static inline u32 Q_INTERPOLATE(u32 A, u32 B, u32 C, u32 D)
164 {
165 register u32 x = ((A & qcolorMask) >> 2) +
166 ((B & qcolorMask) >> 2) +
167 ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2);
168 register u32 y = (A & qlowpixelMask) +
169 (B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask);
171 y = (y >> 2) & qlowpixelMask;
172 return x + y;
173 }
175 static inline int GetResult1_32(u32 A, u32 B, u32 C, u32 D,
176 u32 /* E */)
177 {
178 int x = 0;
179 int y = 0;
180 int r = 0;
182 if (A == C)
183 x += 1;
184 else if (B == C)
185 y += 1;
186 if (A == D)
187 x += 1;
188 else if (B == D)
189 y += 1;
190 if (x <= 1)
191 r += 1;
192 if (y <= 1)
193 r -= 1;
194 return r;
195 }
197 static inline int GetResult2_32(u32 A, u32 B, u32 C, u32 D,
198 u32 /* E */)
199 {
200 int x = 0;
201 int y = 0;
202 int r = 0;
204 if (A == C)
205 x += 1;
206 else if (B == C)
207 y += 1;
208 if (A == D)
209 x += 1;
210 else if (B == D)
211 y += 1;
212 if (x <= 1)
213 r -= 1;
214 if (y <= 1)
215 r += 1;
216 return r;
217 }
219 #define BLUE_MASK565 0x001F001F
220 #define RED_MASK565 0xF800F800
221 #define GREEN_MASK565 0x07E007E0
223 #define BLUE_MASK555 0x001F001F
224 #define RED_MASK555 0x7C007C00
225 #define GREEN_MASK555 0x03E003E0
227 void Super2xSaI(u8 *srcPtr, u32 srcPitch,
228 u8 *deltaPtr, u8 *dstPtr, u32 dstPitch,
229 int width, int height)
230 {
231 u16 *bP;
232 u8 * dP;
233 u32 inc_bP;
234 u32 Nextline = srcPitch >> 1;
235 #ifdef MMX
236 if (cpu_mmx)
237 {
238 for (; height; height--)
239 {
240 _2xSaISuper2xSaILine(srcPtr, deltaPtr, srcPitch, width,
241 dstPtr, dstPitch);
242 srcPtr += srcPitch;
243 dstPtr += dstPitch * 2;
244 deltaPtr += srcPitch;
245 }
246 }
247 else
248 #endif
249 {
250 inc_bP = 1;
252 for (; height; height--)
253 {
254 bP = (u16 *) srcPtr;
255 dP = (u8 *) dstPtr;
257 for (u32 finish = width; finish; finish -= inc_bP)
258 {
259 u32 color4, color5, color6;
260 u32 color1, color2, color3;
261 u32 colorA0, colorA1, colorA2, colorA3,
262 colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
263 u32 product1a, product1b, product2a, product2b;
265 //--------------------------------------- B1 B2
266 // 4 5 6 S2
267 // 1 2 3 S1
268 // A1 A2
270 colorB0 = *(bP - Nextline - 1);
271 colorB1 = *(bP - Nextline);
272 colorB2 = *(bP - Nextline + 1);
273 colorB3 = *(bP - Nextline + 2);
275 color4 = *(bP - 1);
276 color5 = *(bP);
277 color6 = *(bP + 1);
278 colorS2 = *(bP + 2);
280 color1 = *(bP + Nextline - 1);
281 color2 = *(bP + Nextline);
282 color3 = *(bP + Nextline + 1);
283 colorS1 = *(bP + Nextline + 2);
285 colorA0 = *(bP + Nextline + Nextline - 1);
286 colorA1 = *(bP + Nextline + Nextline);
287 colorA2 = *(bP + Nextline + Nextline + 1);
288 colorA3 = *(bP + Nextline + Nextline + 2);
290 //--------------------------------------
291 if (color2 == color6 && color5 != color3)
292 {
293 product2b = product1b = color2;
294 }
295 else if (color5 == color3 && color2 != color6)
296 {
297 product2b = product1b = color5;
298 }
299 else if (color5 == color3 && color2 == color6)
300 {
301 register int r = 0;
303 r += GetResult(color6, color5, color1, colorA1);
304 r += GetResult(color6, color5, color4, colorB1);
305 r += GetResult(color6, color5, colorA2, colorS1);
306 r += GetResult(color6, color5, colorB2, colorS2);
308 if (r > 0)
309 product2b = product1b = color6;
310 else if (r < 0)
311 product2b = product1b = color5;
312 else
313 {
314 product2b = product1b = INTERPOLATE(color5, color6);
315 }
316 }
317 else
318 {
319 if (color6 == color3 && color3 == colorA1
320 && color2 != colorA2 && color3 != colorA0)
321 product2b =
322 Q_INTERPOLATE(color3, color3, color3, color2);
323 else if (color5 == color2 && color2 == colorA2
324 && colorA1 != color3 && color2 != colorA3)
325 product2b =
326 Q_INTERPOLATE(color2, color2, color2, color3);
327 else
328 product2b = INTERPOLATE(color2, color3);
330 if (color6 == color3 && color6 == colorB1
331 && color5 != colorB2 && color6 != colorB0)
332 product1b =
333 Q_INTERPOLATE(color6, color6, color6, color5);
334 else if (color5 == color2 && color5 == colorB2
335 && colorB1 != color6 && color5 != colorB3)
336 product1b =
337 Q_INTERPOLATE(color6, color5, color5, color5);
338 else
339 product1b = INTERPOLATE(color5, color6);
340 }
342 if (color5 == color3 && color2 != color6 && color4 == color5
343 && color5 != colorA2)
344 product2a = INTERPOLATE(color2, color5);
345 else
346 if (color5 == color1 && color6 == color5
347 && color4 != color2 && color5 != colorA0)
348 product2a = INTERPOLATE(color2, color5);
349 else
350 product2a = color2;
352 if (color2 == color6 && color5 != color3 && color1 == color2
353 && color2 != colorB2)
354 product1a = INTERPOLATE(color2, color5);
355 else
356 if (color4 == color2 && color3 == color2
357 && color1 != color5 && color2 != colorB0)
358 product1a = INTERPOLATE(color2, color5);
359 else
360 product1a = color5;
362 #ifdef WORDS_BIGENDIAN
363 product1a = (product1a << 16) | product1b;
364 product2a = (product2a << 16) | product2b;
365 #else
366 product1a = product1a | (product1b << 16);
367 product2a = product2a | (product2b << 16);
368 #endif
370 *((u32 *) dP) = product1a;
371 *((u32 *) (dP + dstPitch)) = product2a;
373 bP += inc_bP;
374 dP += sizeof(u32);
375 } // end of for ( finish= width etc..)
377 srcPtr += srcPitch;
378 dstPtr += dstPitch << 1;
379 deltaPtr += srcPitch;
380 } // endof: for (; height; height--)
381 }
382 }
384 void Super2xSaI32(u8 *srcPtr, u32 srcPitch,
385 u8 * /* deltaPtr */, u8 *dstPtr, u32 dstPitch,
386 int width, int height)
387 {
388 u32 *bP;
389 u32 *dP;
390 u32 inc_bP;
391 u32 Nextline = srcPitch >> 2;
392 inc_bP = 1;
394 for (; height; height--)
395 {
396 bP = (u32 *) srcPtr;
397 dP = (u32 *) dstPtr;
399 for (u32 finish = width; finish; finish -= inc_bP)
400 {
401 u32 color4, color5, color6;
402 u32 color1, color2, color3;
403 u32 colorA0, colorA1, colorA2, colorA3,
404 colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
405 u32 product1a, product1b, product2a, product2b;
407 //--------------------------------------- B1 B2
408 // 4 5 6 S2
409 // 1 2 3 S1
410 // A1 A2
412 colorB0 = *(bP - Nextline - 1);
413 colorB1 = *(bP - Nextline);
414 colorB2 = *(bP - Nextline + 1);
415 colorB3 = *(bP - Nextline + 2);
417 color4 = *(bP - 1);
418 color5 = *(bP);
419 color6 = *(bP + 1);
420 colorS2 = *(bP + 2);
422 color1 = *(bP + Nextline - 1);
423 color2 = *(bP + Nextline);
424 color3 = *(bP + Nextline + 1);
425 colorS1 = *(bP + Nextline + 2);
427 colorA0 = *(bP + Nextline + Nextline - 1);
428 colorA1 = *(bP + Nextline + Nextline);
429 colorA2 = *(bP + Nextline + Nextline + 1);
430 colorA3 = *(bP + Nextline + Nextline + 2);
432 //--------------------------------------
433 if (color2 == color6 && color5 != color3)
434 {
435 product2b = product1b = color2;
436 }
437 else if (color5 == color3 && color2 != color6)
438 {
439 product2b = product1b = color5;
440 }
441 else if (color5 == color3 && color2 == color6)
442 {
443 register int r = 0;
445 r += GetResult(color6, color5, color1, colorA1);
446 r += GetResult(color6, color5, color4, colorB1);
447 r += GetResult(color6, color5, colorA2, colorS1);
448 r += GetResult(color6, color5, colorB2, colorS2);
450 if (r > 0)
451 product2b = product1b = color6;
452 else if (r < 0)
453 product2b = product1b = color5;
454 else
455 {
456 product2b = product1b = INTERPOLATE(color5, color6);
457 }
458 }
459 else
460 {
461 if (color6 == color3 && color3 == colorA1
462 && color2 != colorA2 && color3 != colorA0)
463 product2b =
464 Q_INTERPOLATE(color3, color3, color3, color2);
465 else if (color5 == color2 && color2 == colorA2
466 && colorA1 != color3 && color2 != colorA3)
467 product2b =
468 Q_INTERPOLATE(color2, color2, color2, color3);
469 else
470 product2b = INTERPOLATE(color2, color3);
472 if (color6 == color3 && color6 == colorB1
473 && color5 != colorB2 && color6 != colorB0)
474 product1b =
475 Q_INTERPOLATE(color6, color6, color6, color5);
476 else if (color5 == color2 && color5 == colorB2
477 && colorB1 != color6 && color5 != colorB3)
478 product1b =
479 Q_INTERPOLATE(color6, color5, color5, color5);
480 else
481 product1b = INTERPOLATE(color5, color6);
482 }
484 if (color5 == color3 && color2 != color6 && color4 == color5
485 && color5 != colorA2)
486 product2a = INTERPOLATE(color2, color5);
487 else
488 if (color5 == color1 && color6 == color5
489 && color4 != color2 && color5 != colorA0)
490 product2a = INTERPOLATE(color2, color5);
491 else
492 product2a = color2;
494 if (color2 == color6 && color5 != color3 && color1 == color2
495 && color2 != colorB2)
496 product1a = INTERPOLATE(color2, color5);
497 else
498 if (color4 == color2 && color3 == color2
499 && color1 != color5 && color2 != colorB0)
500 product1a = INTERPOLATE(color2, color5);
501 else
502 product1a = color5;
503 *(dP) = product1a;
504 *(dP + 1) = product1b;
505 *(dP + (dstPitch >> 2)) = product2a;
506 *(dP + (dstPitch >> 2) + 1) = product2b;
508 bP += inc_bP;
509 dP += 2;
510 } // end of for ( finish= width etc..)
512 srcPtr += srcPitch;
513 dstPtr += dstPitch << 1;
514 // deltaPtr += srcPitch;
515 } // endof: for (; height; height--)
516 }
518 void SuperEagle(u8 *srcPtr, u32 srcPitch, u8 *deltaPtr,
519 u8 *dstPtr, u32 dstPitch, int width, int height)
520 {
521 u8 * dP;
522 u16 *bP;
523 u16 *xP;
524 u32 inc_bP;
526 #ifdef MMX
527 if (cpu_mmx)
528 {
529 for (; height; height--)
530 {
531 _2xSaISuperEagleLine(srcPtr, deltaPtr, srcPitch, width,
532 dstPtr, dstPitch);
533 srcPtr += srcPitch;
534 dstPtr += dstPitch * 2;
535 deltaPtr += srcPitch;
536 }
537 }
538 else
539 #endif
540 {
541 inc_bP = 1;
543 u32 Nextline = srcPitch >> 1;
545 for (; height; height--)
546 {
547 bP = (u16 *) srcPtr;
548 xP = (u16 *) deltaPtr;
549 dP = dstPtr;
550 for (u32 finish = width; finish; finish -= inc_bP)
551 {
552 u32 color4, color5, color6;
553 u32 color1, color2, color3;
554 u32 colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
555 u32 product1a, product1b, product2a, product2b;
557 colorB1 = *(bP - Nextline);
558 colorB2 = *(bP - Nextline + 1);
560 color4 = *(bP - 1);
561 color5 = *(bP);
562 color6 = *(bP + 1);
563 colorS2 = *(bP + 2);
565 color1 = *(bP + Nextline - 1);
566 color2 = *(bP + Nextline);
567 color3 = *(bP + Nextline + 1);
568 colorS1 = *(bP + Nextline + 2);
570 colorA1 = *(bP + Nextline + Nextline);
571 colorA2 = *(bP + Nextline + Nextline + 1);
573 // --------------------------------------
574 if (color2 == color6 && color5 != color3)
575 {
576 product1b = product2a = color2;
577 if ((color1 == color2) || (color6 == colorB2))
578 {
579 product1a = INTERPOLATE(color2, color5);
580 product1a = INTERPOLATE(color2, product1a);
581 // product1a = color2;
582 }
583 else
584 {
585 product1a = INTERPOLATE(color5, color6);
586 }
588 if ((color6 == colorS2) || (color2 == colorA1))
589 {
590 product2b = INTERPOLATE(color2, color3);
591 product2b = INTERPOLATE(color2, product2b);
592 // product2b = color2;
593 }
594 else
595 {
596 product2b = INTERPOLATE(color2, color3);
597 }
598 }
599 else if (color5 == color3 && color2 != color6)
600 {
601 product2b = product1a = color5;
603 if ((colorB1 == color5) || (color3 == colorS1))
604 {
605 product1b = INTERPOLATE(color5, color6);
606 product1b = INTERPOLATE(color5, product1b);
607 // product1b = color5;
608 }
609 else
610 {
611 product1b = INTERPOLATE(color5, color6);
612 }
614 if ((color3 == colorA2) || (color4 == color5))
615 {
616 product2a = INTERPOLATE(color5, color2);
617 product2a = INTERPOLATE(color5, product2a);
618 // product2a = color5;
619 }
620 else
621 {
622 product2a = INTERPOLATE(color2, color3);
623 }
624 }
625 else if (color5 == color3 && color2 == color6)
626 {
627 register int r = 0;
629 r += GetResult(color6, color5, color1, colorA1);
630 r += GetResult(color6, color5, color4, colorB1);
631 r += GetResult(color6, color5, colorA2, colorS1);
632 r += GetResult(color6, color5, colorB2, colorS2);
634 if (r > 0)
635 {
636 product1b = product2a = color2;
637 product1a = product2b = INTERPOLATE(color5, color6);
638 }
639 else if (r < 0)
640 {
641 product2b = product1a = color5;
642 product1b = product2a = INTERPOLATE(color5, color6);
643 }
644 else
645 {
646 product2b = product1a = color5;
647 product1b = product2a = color2;
648 }
649 }
650 else
651 {
652 product2b = product1a = INTERPOLATE(color2, color6);
653 product2b =
654 Q_INTERPOLATE(color3, color3, color3, product2b);
655 product1a =
656 Q_INTERPOLATE(color5, color5, color5, product1a);
658 product2a = product1b = INTERPOLATE(color5, color3);
659 product2a =
660 Q_INTERPOLATE(color2, color2, color2, product2a);
661 product1b =
662 Q_INTERPOLATE(color6, color6, color6, product1b);
664 // product1a = color5;
665 // product1b = color6;
666 // product2a = color2;
667 // product2b = color3;
668 }
669 #ifdef WORDS_BIGENDIAN
670 product1a = (product1a << 16) | product1b;
671 product2a = (product2a << 16) | product2b;
672 #else
673 product1a = product1a | (product1b << 16);
674 product2a = product2a | (product2b << 16);
675 #endif
677 *((u32 *) dP) = product1a;
678 *((u32 *) (dP + dstPitch)) = product2a;
679 *xP = color5;
681 bP += inc_bP;
682 xP += inc_bP;
683 dP += sizeof(u32);
684 } // end of for ( finish= width etc..)
686 srcPtr += srcPitch;
687 dstPtr += dstPitch << 1;
688 deltaPtr += srcPitch;
689 } // endof: for (height; height; height--)
690 }
691 }
693 void SuperEagle32(u8 *srcPtr, u32 srcPitch, u8 *deltaPtr,
694 u8 *dstPtr, u32 dstPitch, int width, int height)
695 {
696 u32 *dP;
697 u32 *bP;
698 u32 *xP;
699 u32 inc_bP;
701 inc_bP = 1;
703 u32 Nextline = srcPitch >> 2;
705 for (; height; height--)
706 {
707 bP = (u32 *) srcPtr;
708 xP = (u32 *) deltaPtr;
709 dP = (u32 *)dstPtr;
710 for (u32 finish = width; finish; finish -= inc_bP)
711 {
712 u32 color4, color5, color6;
713 u32 color1, color2, color3;
714 u32 colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
715 u32 product1a, product1b, product2a, product2b;
717 colorB1 = *(bP - Nextline);
718 colorB2 = *(bP - Nextline + 1);
720 color4 = *(bP - 1);
721 color5 = *(bP);
722 color6 = *(bP + 1);
723 colorS2 = *(bP + 2);
725 color1 = *(bP + Nextline - 1);
726 color2 = *(bP + Nextline);
727 color3 = *(bP + Nextline + 1);
728 colorS1 = *(bP + Nextline + 2);
730 colorA1 = *(bP + Nextline + Nextline);
731 colorA2 = *(bP + Nextline + Nextline + 1);
733 // --------------------------------------
734 if (color2 == color6 && color5 != color3)
735 {
736 product1b = product2a = color2;
737 if ((color1 == color2) || (color6 == colorB2))
738 {
739 product1a = INTERPOLATE(color2, color5);
740 product1a = INTERPOLATE(color2, product1a);
741 // product1a = color2;
742 }
743 else
744 {
745 product1a = INTERPOLATE(color5, color6);
746 }
748 if ((color6 == colorS2) || (color2 == colorA1))
749 {
750 product2b = INTERPOLATE(color2, color3);
751 product2b = INTERPOLATE(color2, product2b);
752 // product2b = color2;
753 }
754 else
755 {
756 product2b = INTERPOLATE(color2, color3);
757 }
758 }
759 else if (color5 == color3 && color2 != color6)
760 {
761 product2b = product1a = color5;
763 if ((colorB1 == color5) || (color3 == colorS1))
764 {
765 product1b = INTERPOLATE(color5, color6);
766 product1b = INTERPOLATE(color5, product1b);
767 // product1b = color5;
768 }
769 else
770 {
771 product1b = INTERPOLATE(color5, color6);
772 }
774 if ((color3 == colorA2) || (color4 == color5))
775 {
776 product2a = INTERPOLATE(color5, color2);
777 product2a = INTERPOLATE(color5, product2a);
778 // product2a = color5;
779 }
780 else
781 {
782 product2a = INTERPOLATE(color2, color3);
783 }
784 }
785 else if (color5 == color3 && color2 == color6)
786 {
787 register int r = 0;
789 r += GetResult(color6, color5, color1, colorA1);
790 r += GetResult(color6, color5, color4, colorB1);
791 r += GetResult(color6, color5, colorA2, colorS1);
792 r += GetResult(color6, color5, colorB2, colorS2);
794 if (r > 0)
795 {
796 product1b = product2a = color2;
797 product1a = product2b = INTERPOLATE(color5, color6);
798 }
799 else if (r < 0)
800 {
801 product2b = product1a = color5;
802 product1b = product2a = INTERPOLATE(color5, color6);
803 }
804 else
805 {
806 product2b = product1a = color5;
807 product1b = product2a = color2;
808 }
809 }
810 else
811 {
812 product2b = product1a = INTERPOLATE(color2, color6);
813 product2b =
814 Q_INTERPOLATE(color3, color3, color3, product2b);
815 product1a =
816 Q_INTERPOLATE(color5, color5, color5, product1a);
818 product2a = product1b = INTERPOLATE(color5, color3);
819 product2a =
820 Q_INTERPOLATE(color2, color2, color2, product2a);
821 product1b =
822 Q_INTERPOLATE(color6, color6, color6, product1b);
824 // product1a = color5;
825 // product1b = color6;
826 // product2a = color2;
827 // product2b = color3;
828 }
829 *(dP) = product1a;
830 *(dP + 1) = product1b;
831 *(dP + (dstPitch >> 2)) = product2a;
832 *(dP + (dstPitch >> 2) + 1) = product2b;
833 *xP = color5;
835 bP += inc_bP;
836 xP += inc_bP;
837 dP += 2;
838 } // end of for ( finish= width etc..)
840 srcPtr += srcPitch;
841 dstPtr += dstPitch << 1;
842 deltaPtr += srcPitch;
843 } // endof: for (height; height; height--)
844 }
846 void _2xSaI(u8 *srcPtr, u32 srcPitch, u8 *deltaPtr,
847 u8 *dstPtr, u32 dstPitch, int width, int height)
848 {
849 u8 * dP;
850 u16 *bP;
851 u32 inc_bP;
853 #ifdef MMX
854 if (cpu_mmx)
855 {
856 for (; height; height -= 1)
857 {
858 _2xSaILine(srcPtr, deltaPtr, srcPitch, width, dstPtr, dstPitch);
859 srcPtr += srcPitch;
860 dstPtr += dstPitch * 2;
861 deltaPtr += srcPitch;
862 }
863 }
864 else
865 #endif
866 {
867 inc_bP = 1;
869 u32 Nextline = srcPitch >> 1;
871 for (; height; height--)
872 {
873 bP = (u16 *) srcPtr;
874 dP = dstPtr;
876 for (u32 finish = width; finish; finish -= inc_bP)
877 {
878 register u32 colorA, colorB;
879 u32 colorC, colorD,
880 colorE, colorF, colorG, colorH,
881 colorI, colorJ, colorK, colorL,
883 colorM, colorN, colorO, colorP;
884 u32 product, product1, product2;
886 //---------------------------------------
887 // Map of the pixels: I|E F|J
888 // G|A B|K
889 // H|C D|L
890 // M|N O|P
891 colorI = *(bP - Nextline - 1);
892 colorE = *(bP - Nextline);
893 colorF = *(bP - Nextline + 1);
894 colorJ = *(bP - Nextline + 2);
896 colorG = *(bP - 1);
897 colorA = *(bP);
898 colorB = *(bP + 1);
899 colorK = *(bP + 2);
901 colorH = *(bP + Nextline - 1);
902 colorC = *(bP + Nextline);
903 colorD = *(bP + Nextline + 1);
904 colorL = *(bP + Nextline + 2);
906 colorM = *(bP + Nextline + Nextline - 1);
907 colorN = *(bP + Nextline + Nextline);
908 colorO = *(bP + Nextline + Nextline + 1);
909 colorP = *(bP + Nextline + Nextline + 2);
911 if ((colorA == colorD) && (colorB != colorC))
912 {
913 if (((colorA == colorE) && (colorB == colorL)) ||
914 ((colorA == colorC) && (colorA == colorF)
915 && (colorB != colorE) && (colorB == colorJ)))
916 {
917 product = colorA;
918 }
919 else
920 {
921 product = INTERPOLATE(colorA, colorB);
922 }
924 if (((colorA == colorG) && (colorC == colorO)) ||
925 ((colorA == colorB) && (colorA == colorH)
926 && (colorG != colorC) && (colorC == colorM)))
927 {
928 product1 = colorA;
929 }
930 else
931 {
932 product1 = INTERPOLATE(colorA, colorC);
933 }
934 product2 = colorA;
935 }
936 else if ((colorB == colorC) && (colorA != colorD))
937 {
938 if (((colorB == colorF) && (colorA == colorH)) ||
939 ((colorB == colorE) && (colorB == colorD)
940 && (colorA != colorF) && (colorA == colorI)))
941 {
942 product = colorB;
943 }
944 else
945 {
946 product = INTERPOLATE(colorA, colorB);
947 }
949 if (((colorC == colorH) && (colorA == colorF)) ||
950 ((colorC == colorG) && (colorC == colorD)
951 && (colorA != colorH) && (colorA == colorI)))
952 {
953 product1 = colorC;
954 }
955 else
956 {
957 product1 = INTERPOLATE(colorA, colorC);
958 }
959 product2 = colorB;
960 }
961 else if ((colorA == colorD) && (colorB == colorC))
962 {
963 if (colorA == colorB)
964 {
965 product = colorA;
966 product1 = colorA;
967 product2 = colorA;
968 }
969 else
970 {
971 register int r = 0;
973 product1 = INTERPOLATE(colorA, colorC);
974 product = INTERPOLATE(colorA, colorB);
976 r +=
977 GetResult1(colorA, colorB, colorG, colorE,
978 colorI);
979 r +=
980 GetResult2(colorB, colorA, colorK, colorF,
981 colorJ);
982 r +=
983 GetResult2(colorB, colorA, colorH, colorN,
984 colorM);
985 r +=
986 GetResult1(colorA, colorB, colorL, colorO,
987 colorP);
989 if (r > 0)
990 product2 = colorA;
991 else if (r < 0)
992 product2 = colorB;
993 else
994 {
995 product2 =
996 Q_INTERPOLATE(colorA, colorB, colorC,
997 colorD);
998 }
999 }
1001 else
1003 product2 = Q_INTERPOLATE(colorA, colorB, colorC, colorD);
1005 if ((colorA == colorC) && (colorA == colorF)
1006 && (colorB != colorE) && (colorB == colorJ))
1008 product = colorA;
1010 else if ((colorB == colorE) && (colorB == colorD)
1011 && (colorA != colorF) && (colorA == colorI))
1013 product = colorB;
1015 else
1017 product = INTERPOLATE(colorA, colorB);
1020 if ((colorA == colorB) && (colorA == colorH)
1021 && (colorG != colorC) && (colorC == colorM))
1023 product1 = colorA;
1025 else if ((colorC == colorG) && (colorC == colorD)
1026 && (colorA != colorH) && (colorA == colorI))
1028 product1 = colorC;
1030 else
1032 product1 = INTERPOLATE(colorA, colorC);
1036 #ifdef WORDS_BIGENDIAN
1037 product = (colorA << 16) | product;
1038 product1 = (product1 << 16) | product2;
1039 #else
1040 product = colorA | (product << 16);
1041 product1 = product1 | (product2 << 16);
1042 #endif
1043 *((s32 *) dP) = product;
1044 *((u32 *) (dP + dstPitch)) = product1;
1046 bP += inc_bP;
1047 dP += sizeof(u32);
1048 } // end of for ( finish= width etc..)
1050 srcPtr += srcPitch;
1051 dstPtr += dstPitch << 1;
1052 deltaPtr += srcPitch;
1053 } // endof: for (height; height; height--)
1057 void _2xSaI32(u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,
1058 u8 *dstPtr, u32 dstPitch, int width, int height)
1060 u32 *dP;
1061 u32 *bP;
1062 u32 inc_bP = 1;
1064 u32 Nextline = srcPitch >> 2;
1066 for (; height; height--)
1068 bP = (u32 *) srcPtr;
1069 dP = (u32 *) dstPtr;
1071 for (u32 finish = width; finish; finish -= inc_bP)
1073 register u32 colorA, colorB;
1074 u32 colorC, colorD,
1075 colorE, colorF, colorG, colorH,
1076 colorI, colorJ, colorK, colorL,
1078 colorM, colorN, colorO, colorP;
1079 u32 product, product1, product2;
1081 //---------------------------------------
1082 // Map of the pixels: I|E F|J
1083 // G|A B|K
1084 // H|C D|L
1085 // M|N O|P
1086 colorI = *(bP - Nextline - 1);
1087 colorE = *(bP - Nextline);
1088 colorF = *(bP - Nextline + 1);
1089 colorJ = *(bP - Nextline + 2);
1091 colorG = *(bP - 1);
1092 colorA = *(bP);
1093 colorB = *(bP + 1);
1094 colorK = *(bP + 2);
1096 colorH = *(bP + Nextline - 1);
1097 colorC = *(bP + Nextline);
1098 colorD = *(bP + Nextline + 1);
1099 colorL = *(bP + Nextline + 2);
1101 colorM = *(bP + Nextline + Nextline - 1);
1102 colorN = *(bP + Nextline + Nextline);
1103 colorO = *(bP + Nextline + Nextline + 1);
1104 colorP = *(bP + Nextline + Nextline + 2);
1106 if ((colorA == colorD) && (colorB != colorC))
1108 if (((colorA == colorE) && (colorB == colorL)) ||
1109 ((colorA == colorC) && (colorA == colorF)
1110 && (colorB != colorE) && (colorB == colorJ)))
1112 product = colorA;
1114 else
1116 product = INTERPOLATE(colorA, colorB);
1119 if (((colorA == colorG) && (colorC == colorO)) ||
1120 ((colorA == colorB) && (colorA == colorH)
1121 && (colorG != colorC) && (colorC == colorM)))
1123 product1 = colorA;
1125 else
1127 product1 = INTERPOLATE(colorA, colorC);
1129 product2 = colorA;
1131 else if ((colorB == colorC) && (colorA != colorD))
1133 if (((colorB == colorF) && (colorA == colorH)) ||
1134 ((colorB == colorE) && (colorB == colorD)
1135 && (colorA != colorF) && (colorA == colorI)))
1137 product = colorB;
1139 else
1141 product = INTERPOLATE(colorA, colorB);
1144 if (((colorC == colorH) && (colorA == colorF)) ||
1145 ((colorC == colorG) && (colorC == colorD)
1146 && (colorA != colorH) && (colorA == colorI)))
1148 product1 = colorC;
1150 else
1152 product1 = INTERPOLATE(colorA, colorC);
1154 product2 = colorB;
1156 else if ((colorA == colorD) && (colorB == colorC))
1158 if (colorA == colorB)
1160 product = colorA;
1161 product1 = colorA;
1162 product2 = colorA;
1164 else
1166 register int r = 0;
1168 product1 = INTERPOLATE(colorA, colorC);
1169 product = INTERPOLATE(colorA, colorB);
1171 r +=
1172 GetResult1(colorA, colorB, colorG, colorE,
1173 colorI);
1174 r +=
1175 GetResult2(colorB, colorA, colorK, colorF,
1176 colorJ);
1177 r +=
1178 GetResult2(colorB, colorA, colorH, colorN,
1179 colorM);
1180 r +=
1181 GetResult1(colorA, colorB, colorL, colorO,
1182 colorP);
1184 if (r > 0)
1185 product2 = colorA;
1186 else if (r < 0)
1187 product2 = colorB;
1188 else
1190 product2 =
1191 Q_INTERPOLATE(colorA, colorB, colorC,
1192 colorD);
1196 else
1198 product2 = Q_INTERPOLATE(colorA, colorB, colorC, colorD);
1200 if ((colorA == colorC) && (colorA == colorF)
1201 && (colorB != colorE) && (colorB == colorJ))
1203 product = colorA;
1205 else if ((colorB == colorE) && (colorB == colorD)
1206 && (colorA != colorF) && (colorA == colorI))
1208 product = colorB;
1210 else
1212 product = INTERPOLATE(colorA, colorB);
1215 if ((colorA == colorB) && (colorA == colorH)
1216 && (colorG != colorC) && (colorC == colorM))
1218 product1 = colorA;
1220 else if ((colorC == colorG) && (colorC == colorD)
1221 && (colorA != colorH) && (colorA == colorI))
1223 product1 = colorC;
1225 else
1227 product1 = INTERPOLATE(colorA, colorC);
1230 *(dP) = colorA;
1231 *(dP + 1) = product;
1232 *(dP + (dstPitch >> 2)) = product1;
1233 *(dP + (dstPitch >> 2) + 1) = product2;
1235 bP += inc_bP;
1236 dP += 2;
1237 } // end of for ( finish= width etc..)
1239 srcPtr += srcPitch;
1240 dstPtr += dstPitch << 1;
1241 // deltaPtr += srcPitch;
1242 } // endof: for (height; height; height--)
1245 static u32 Bilinear(u32 A, u32 B, u32 x)
1247 unsigned long areaA, areaB;
1248 unsigned long result;
1250 if (A == B)
1251 return A;
1253 areaB = (x >> 11) & 0x1f; // reduce 16 bit fraction to 5 bits
1254 areaA = 0x20 - areaB;
1256 A = (A & redblueMask) | ((A & greenMask) << 16);
1257 B = (B & redblueMask) | ((B & greenMask) << 16);
1259 result = ((areaA * A) + (areaB * B)) >> 5;
1261 return (result & redblueMask) | ((result >> 16) & greenMask);
1264 static u32 Bilinear4(u32 A, u32 B, u32 C, u32 D, u32 x,
1265 u32 y)
1267 unsigned long areaA, areaB, areaC, areaD;
1268 unsigned long result, xy;
1270 x = (x >> 11) & 0x1f;
1271 y = (y >> 11) & 0x1f;
1272 xy = (x * y) >> 5;
1274 A = (A & redblueMask) | ((A & greenMask) << 16);
1275 B = (B & redblueMask) | ((B & greenMask) << 16);
1276 C = (C & redblueMask) | ((C & greenMask) << 16);
1277 D = (D & redblueMask) | ((D & greenMask) << 16);
1279 areaA = 0x20 + xy - x - y;
1280 areaB = x - xy;
1281 areaC = y - xy;
1282 areaD = xy;
1284 result = ((areaA * A) + (areaB * B) + (areaC * C) + (areaD * D)) >> 5;
1286 return (result & redblueMask) | ((result >> 16) & greenMask);
1289 void Scale_2xSaI(u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,
1290 u8 *dstPtr, u32 dstPitch,
1291 u32 dstWidth, u32 dstHeight, int width, int height)
1293 u8 * dP;
1294 u16 *bP;
1296 u32 w;
1297 u32 h;
1298 u32 dw;
1299 u32 dh;
1300 u32 hfinish;
1301 u32 wfinish;
1303 u32 Nextline = srcPitch >> 1;
1305 wfinish = (width - 1) << 16; // convert to fixed point
1306 dw = wfinish / (dstWidth - 1);
1307 hfinish = (height - 1) << 16; // convert to fixed point
1308 dh = hfinish / (dstHeight - 1);
1310 for (h = 0; h < hfinish; h += dh)
1312 u32 y1, y2;
1314 y1 = h & 0xffff; // fraction part of fixed point
1315 bP = (u16 *) (srcPtr + ((h >> 16) * srcPitch));
1316 dP = dstPtr;
1317 y2 = 0x10000 - y1;
1319 w = 0;
1321 for (; w < wfinish; )
1323 u32 A, B, C, D;
1324 u32 E, F, G, H;
1325 u32 I, J, K, L;
1326 u32 x1, x2, a1, f1, f2;
1327 u32 position, product1;
1329 position = w >> 16;
1330 A = bP[position]; // current pixel
1331 B = bP[position + 1]; // next pixel
1332 C = bP[position + Nextline];
1333 D = bP[position + Nextline + 1];
1334 E = bP[position - Nextline];
1335 F = bP[position - Nextline + 1];
1336 G = bP[position - 1];
1337 H = bP[position + Nextline - 1];
1338 I = bP[position + 2];
1339 J = bP[position + Nextline + 2];
1340 K = bP[position + Nextline + Nextline];
1341 L = bP[position + Nextline + Nextline + 1];
1343 x1 = w & 0xffff; // fraction part of fixed point
1344 x2 = 0x10000 - x1;
1346 /*0*/
1347 if (A == B && C == D && A == C)
1348 product1 = A;
1349 else /*1*/ if (A == D && B != C)
1351 f1 = (x1 >> 1) + (0x10000 >> 2);
1352 f2 = (y1 >> 1) + (0x10000 >> 2);
1353 if (y1 <= f1 && A == J && A != E) // close to B
1355 a1 = f1 - y1;
1356 product1 = Bilinear(A, B, a1);
1358 else if (y1 >= f1 && A == G && A != L) // close to C
1360 a1 = y1 - f1;
1361 product1 = Bilinear(A, C, a1);
1363 else if (x1 >= f2 && A == E && A != J) // close to B
1365 a1 = x1 - f2;
1366 product1 = Bilinear(A, B, a1);
1368 else if (x1 <= f2 && A == L && A != G) // close to C
1370 a1 = f2 - x1;
1371 product1 = Bilinear(A, C, a1);
1373 else if (y1 >= x1) // close to C
1375 a1 = y1 - x1;
1376 product1 = Bilinear(A, C, a1);
1378 else if (y1 <= x1) // close to B
1380 a1 = x1 - y1;
1381 product1 = Bilinear(A, B, a1);
1384 else
1385 /*2*/
1386 if (B == C && A != D)
1388 f1 = (x1 >> 1) + (0x10000 >> 2);
1389 f2 = (y1 >> 1) + (0x10000 >> 2);
1390 if (y2 >= f1 && B == H && B != F) // close to A
1392 a1 = y2 - f1;
1393 product1 = Bilinear(B, A, a1);
1395 else if (y2 <= f1 && B == I && B != K) // close to D
1397 a1 = f1 - y2;
1398 product1 = Bilinear(B, D, a1);
1400 else if (x2 >= f2 && B == F && B != H) // close to A
1402 a1 = x2 - f2;
1403 product1 = Bilinear(B, A, a1);
1405 else if (x2 <= f2 && B == K && B != I) // close to D
1407 a1 = f2 - x2;
1408 product1 = Bilinear(B, D, a1);
1410 else if (y2 >= x1) // close to A
1412 a1 = y2 - x1;
1413 product1 = Bilinear(B, A, a1);
1415 else if (y2 <= x1) // close to D
1417 a1 = x1 - y2;
1418 product1 = Bilinear(B, D, a1);
1421 /*3*/
1422 else
1424 product1 = Bilinear4(A, B, C, D, x1, y1);
1427 //end First Pixel
1428 *(u32 *) dP = product1;
1429 dP += 2;
1430 w += dw;
1432 dstPtr += dstPitch;