home *** CD-ROM | disk | FTP | other *** search
/ Chip 2004 July / CMCD0704.ISO / Software / Freeware / Utilitare / VisualBoyAdvance-1.7.2 / src / 2xSaI.cpp next >
Encoding:
C/C++ Source or Header  |  2004-01-25  |  38.6 KB  |  1,275 lines
  1. #include "System.h"
  2. #include "Port.h"
  3.  
  4. extern "C"
  5. {
  6.  
  7. #ifdef MMX
  8.   void _2xSaILine (u8 *srcPtr, u8 *deltaPtr, u32 srcPitch,
  9.                    u32 width, u8 *dstPtr, u32 dstPitch);
  10.   void _2xSaISuperEagleLine (u8 *srcPtr, u8 *deltaPtr,
  11.                              u32 srcPitch, u32 width,
  12.                              u8 *dstPtr, u32 dstPitch);
  13.   void _2xSaISuper2xSaILine (u8 *srcPtr, u8 *deltaPtr,
  14.                              u32 srcPitch, u32 width,
  15.                              u8 *dstPtr, u32 dstPitch);
  16.     void Init_2xSaIMMX (u32 BitFormat);
  17.   void BilinearMMX (u16 * A, u16 * B, u16 * C, u16 * D,
  18.                     u16 * dx, u16 * dy, u8 *dP);
  19.   void BilinearMMXGrid0 (u16 * A, u16 * B, u16 * C, u16 * D,
  20.                          u16 * dx, u16 * dy, u8 *dP);
  21.   void BilinearMMXGrid1 (u16 * A, u16 * B, u16 * C, u16 * D,
  22.                          u16 * dx, u16 * dy, u8 *dP);
  23.   void EndMMX ();
  24.   
  25.   bool cpu_mmx = 1;
  26. #endif
  27. } 
  28. static u32 colorMask = 0xF7DEF7DE;
  29. static u32 lowPixelMask = 0x08210821;
  30. static u32 qcolorMask = 0xE79CE79C;
  31. static u32 qlowpixelMask = 0x18631863;
  32. static u32 redblueMask = 0xF81F;
  33. static u32 greenMask = 0x7E0;
  34.  
  35. u32 qRGB_COLOR_MASK[2] = { 0xF7DEF7DE, 0xF7DEF7DE };
  36.  
  37. extern void hq2x_init(unsigned);
  38.  
  39. int Init_2xSaI(u32 BitFormat)
  40. {
  41.   if(systemColorDepth == 16) {
  42.     if (BitFormat == 565) {
  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.     } else if (BitFormat == 555) {
  52.       colorMask = 0x7BDE7BDE;
  53.       lowPixelMask = 0x04210421;
  54.       qcolorMask = 0x739C739C;
  55.       qlowpixelMask = 0x0C630C63;
  56.       redblueMask = 0x7C1F;
  57.       greenMask = 0x3E0;
  58.       qRGB_COLOR_MASK[0] = qRGB_COLOR_MASK[1] = 0x7BDE7BDE;
  59.       hq2x_init(15);
  60.     } else {
  61.       return 0;
  62.     }
  63.   } else if(systemColorDepth == 32) {
  64.     colorMask = 0xfefefe;
  65.     lowPixelMask = 0x010101;
  66.     qcolorMask = 0xfcfcfc;
  67.     qlowpixelMask = 0x030303;
  68.     qRGB_COLOR_MASK[0] = qRGB_COLOR_MASK[1] = 0xfefefe;
  69.     hq2x_init(32);
  70.   } else
  71.     return 0;
  72.  
  73. #ifdef MMX
  74.     Init_2xSaIMMX (BitFormat);
  75. #endif
  76.   
  77.   return 1;
  78. }
  79.  
  80. static inline int GetResult1 (u32 A, u32 B, u32 C, u32 D,
  81.                               u32 /* E */)
  82. {
  83.     int x = 0;
  84.     int y = 0;
  85.     int r = 0;
  86.  
  87.     if (A == C)
  88.       x += 1;
  89.     else if (B == C)
  90.       y += 1;
  91.     if (A == D)
  92.       x += 1;
  93.     else if (B == D)
  94.       y += 1;
  95.     if (x <= 1)
  96.       r += 1;
  97.     if (y <= 1)
  98.       r -= 1;
  99.     return r;
  100. }
  101.  
  102. static inline int GetResult2 (u32 A, u32 B, u32 C, u32 D,
  103.                               u32 /* E */)
  104. {
  105.   int x = 0;
  106.   int y = 0;
  107.   int r = 0;
  108.   
  109.   if (A == C)
  110.     x += 1;
  111.   else if (B == C)
  112.     y += 1;
  113.   if (A == D)
  114.     x += 1;
  115.   else if (B == D)
  116.     y += 1;
  117.   if (x <= 1)
  118.     r -= 1;
  119.   if (y <= 1)
  120.     r += 1;
  121.   return r;
  122. }
  123.  
  124. static inline int GetResult (u32 A, u32 B, u32 C, u32 D)
  125. {
  126.   int x = 0;
  127.   int y = 0;
  128.   int r = 0;
  129.   
  130.   if (A == C)
  131.     x += 1;
  132.   else if (B == C)
  133.     y += 1;
  134.   if (A == D)
  135.     x += 1;
  136.   else if (B == D)
  137.     y += 1;
  138.   if (x <= 1)
  139.     r += 1;
  140.   if (y <= 1)
  141.     r -= 1;
  142.   return r;
  143. }
  144.  
  145. static inline u32 INTERPOLATE (u32 A, u32 B)
  146. {
  147.   if (A != B) {
  148.     return (((A & colorMask) >> 1) + ((B & colorMask) >> 1) +
  149.             (A & B & lowPixelMask));
  150.   } else
  151.     return A;
  152. }
  153.  
  154. static inline u32 Q_INTERPOLATE (u32 A, u32 B, u32 C, u32 D)
  155. {
  156.   register u32 x = ((A & qcolorMask) >> 2) +
  157.     ((B & qcolorMask) >> 2) +
  158.     ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2);
  159.   register u32 y = (A & qlowpixelMask) +
  160.     (B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask);
  161.   
  162.   y = (y >> 2) & qlowpixelMask;
  163.   return x + y;
  164. }
  165.  
  166. static inline int GetResult1_32 (u32 A, u32 B, u32 C, u32 D,
  167.                                  u32 /* E */)
  168. {
  169.     int x = 0;
  170.     int y = 0;
  171.     int r = 0;
  172.  
  173.     if (A == C)
  174.       x += 1;
  175.     else if (B == C)
  176.       y += 1;
  177.     if (A == D)
  178.       x += 1;
  179.     else if (B == D)
  180.       y += 1;
  181.     if (x <= 1)
  182.       r += 1;
  183.     if (y <= 1)
  184.       r -= 1;
  185.     return r;
  186. }
  187.  
  188. static inline int GetResult2_32 (u32 A, u32 B, u32 C, u32 D,
  189.                                  u32 /* E */)
  190. {
  191.   int x = 0;
  192.   int y = 0;
  193.   int r = 0;
  194.   
  195.   if (A == C)
  196.     x += 1;
  197.   else if (B == C)
  198.     y += 1;
  199.   if (A == D)
  200.     x += 1;
  201.   else if (B == D)
  202.     y += 1;
  203.   if (x <= 1)
  204.     r -= 1;
  205.   if (y <= 1)
  206.     r += 1;
  207.   return r;
  208. }
  209.  
  210. #define BLUE_MASK565 0x001F001F
  211. #define RED_MASK565 0xF800F800
  212. #define GREEN_MASK565 0x07E007E0
  213.  
  214. #define BLUE_MASK555 0x001F001F
  215. #define RED_MASK555 0x7C007C00
  216. #define GREEN_MASK555 0x03E003E0
  217.  
  218. void Super2xSaI (u8 *srcPtr, u32 srcPitch,
  219.                  u8 *deltaPtr, u8 *dstPtr, u32 dstPitch,
  220.                  int width, int height)
  221. {
  222.   u16 *bP;
  223.   u8  *dP;
  224.   u32 inc_bP;
  225.   u32 Nextline = srcPitch >> 1;
  226. #ifdef MMX
  227.   if (cpu_mmx) {
  228.     for (; height; height--) {
  229.       _2xSaISuper2xSaILine (srcPtr, deltaPtr, srcPitch, width,
  230.                             dstPtr, dstPitch);
  231.       srcPtr += srcPitch;
  232.       dstPtr += dstPitch * 2;
  233.       deltaPtr += srcPitch;
  234.     }
  235.   } else
  236. #endif
  237.     {
  238.       inc_bP = 1;
  239.       
  240.       for (; height; height--) {
  241.         bP = (u16 *) srcPtr;
  242.         dP = (u8 *) dstPtr;
  243.         
  244.         for (u32 finish = width; finish; finish -= inc_bP) {
  245.           u32 color4, color5, color6;
  246.           u32 color1, color2, color3;
  247.           u32 colorA0, colorA1, colorA2, colorA3,
  248.             colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
  249.           u32 product1a, product1b, product2a, product2b;
  250.           
  251.           //---------------------------------------    B1 B2
  252.           //                                         4  5  6 S2
  253.           //                                         1  2  3 S1
  254.           //                                           A1 A2
  255.           
  256.           colorB0 = *(bP - Nextline - 1);
  257.           colorB1 = *(bP - Nextline);
  258.           colorB2 = *(bP - Nextline + 1);
  259.           colorB3 = *(bP - Nextline + 2);
  260.           
  261.           color4 = *(bP - 1);
  262.           color5 = *(bP);
  263.           color6 = *(bP + 1);
  264.           colorS2 = *(bP + 2);
  265.           
  266.           color1 = *(bP + Nextline - 1);
  267.           color2 = *(bP + Nextline);
  268.           color3 = *(bP + Nextline + 1);
  269.           colorS1 = *(bP + Nextline + 2);
  270.           
  271.           colorA0 = *(bP + Nextline + Nextline - 1);
  272.           colorA1 = *(bP + Nextline + Nextline);
  273.           colorA2 = *(bP + Nextline + Nextline + 1);
  274.           colorA3 = *(bP + Nextline + Nextline + 2);
  275.           
  276.           //--------------------------------------
  277.           if (color2 == color6 && color5 != color3) {
  278.             product2b = product1b = color2;
  279.           } else if (color5 == color3 && color2 != color6) {
  280.             product2b = product1b = color5;
  281.           } else if (color5 == color3 && color2 == color6) {
  282.             register int r = 0;
  283.             
  284.             r += GetResult (color6, color5, color1, colorA1);
  285.             r += GetResult (color6, color5, color4, colorB1);
  286.             r += GetResult (color6, color5, colorA2, colorS1);
  287.             r += GetResult (color6, color5, colorB2, colorS2);
  288.             
  289.             if (r > 0)
  290.               product2b = product1b = color6;
  291.             else if (r < 0)
  292.               product2b = product1b = color5;
  293.             else {
  294.               product2b = product1b = INTERPOLATE (color5, color6);
  295.             }
  296.           } else {
  297.             if (color6 == color3 && color3 == colorA1
  298.                 && color2 != colorA2 && color3 != colorA0)
  299.               product2b =
  300.                 Q_INTERPOLATE (color3, color3, color3, color2);
  301.             else if (color5 == color2 && color2 == colorA2
  302.                      && colorA1 != color3 && color2 != colorA3)
  303.               product2b =
  304.                 Q_INTERPOLATE (color2, color2, color2, color3);
  305.             else
  306.               product2b = INTERPOLATE (color2, color3);
  307.             
  308.             if (color6 == color3 && color6 == colorB1
  309.                 && color5 != colorB2 && color6 != colorB0)
  310.               product1b =
  311.                 Q_INTERPOLATE (color6, color6, color6, color5);
  312.             else if (color5 == color2 && color5 == colorB2
  313.                      && colorB1 != color6 && color5 != colorB3)
  314.               product1b =
  315.                 Q_INTERPOLATE (color6, color5, color5, color5);
  316.             else
  317.               product1b = INTERPOLATE (color5, color6);
  318.           }
  319.           
  320.           if (color5 == color3 && color2 != color6 && color4 == color5
  321.               && color5 != colorA2)
  322.             product2a = INTERPOLATE (color2, color5);
  323.           else
  324.             if (color5 == color1 && color6 == color5
  325.                 && color4 != color2 && color5 != colorA0)
  326.               product2a = INTERPOLATE (color2, color5);
  327.             else
  328.               product2a = color2;
  329.           
  330.           if (color2 == color6 && color5 != color3 && color1 == color2
  331.               && color2 != colorB2)
  332.             product1a = INTERPOLATE (color2, color5);
  333.           else
  334.             if (color4 == color2 && color3 == color2
  335.                 && color1 != color5 && color2 != colorB0)
  336.               product1a = INTERPOLATE (color2, color5);
  337.             else
  338.               product1a = color5;
  339.           
  340. #ifdef WORDS_BIGENDIAN
  341.           product1a = (product1a << 16) | product1b;
  342.           product2a = (product2a << 16) | product2b;
  343. #else
  344.           product1a = product1a | (product1b << 16);
  345.           product2a = product2a | (product2b << 16);
  346. #endif
  347.           
  348.           *((u32 *) dP) = product1a;
  349.           *((u32 *) (dP + dstPitch)) = product2a;
  350.           
  351.           bP += inc_bP;
  352.           dP += sizeof (u32);
  353.         }                       // end of for ( finish= width etc..)
  354.         
  355.         srcPtr   += srcPitch;
  356.         dstPtr   += dstPitch << 1;
  357.         deltaPtr += srcPitch;
  358.       }                 // endof: for (; height; height--)
  359.     }
  360. }
  361.  
  362. void Super2xSaI32 (u8 *srcPtr, u32 srcPitch,
  363.                    u8 * /* deltaPtr */, u8 *dstPtr, u32 dstPitch,
  364.                    int width, int height)
  365. {
  366.   u32 *bP;
  367.   u32 *dP;
  368.   u32 inc_bP;
  369.   u32 Nextline = srcPitch >> 2;
  370.   inc_bP = 1;
  371.   
  372.   for (; height; height--) {
  373.     bP = (u32 *) srcPtr;
  374.     dP = (u32 *) dstPtr;
  375.     
  376.     for (u32 finish = width; finish; finish -= inc_bP) {
  377.       u32 color4, color5, color6;
  378.       u32 color1, color2, color3;
  379.       u32 colorA0, colorA1, colorA2, colorA3,
  380.         colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
  381.       u32 product1a, product1b, product2a, product2b;
  382.       
  383.       //---------------------------------------    B1 B2
  384.       //                                         4  5  6 S2
  385.       //                                         1  2  3 S1
  386.       //                                           A1 A2
  387.       
  388.       colorB0 = *(bP - Nextline - 1);
  389.       colorB1 = *(bP - Nextline);
  390.       colorB2 = *(bP - Nextline + 1);
  391.       colorB3 = *(bP - Nextline + 2);
  392.       
  393.       color4 = *(bP - 1);
  394.       color5 = *(bP);
  395.       color6 = *(bP + 1);
  396.       colorS2 = *(bP + 2);
  397.       
  398.       color1 = *(bP + Nextline - 1);
  399.       color2 = *(bP + Nextline);
  400.       color3 = *(bP + Nextline + 1);
  401.       colorS1 = *(bP + Nextline + 2);
  402.       
  403.       colorA0 = *(bP + Nextline + Nextline - 1);
  404.       colorA1 = *(bP + Nextline + Nextline);
  405.       colorA2 = *(bP + Nextline + Nextline + 1);
  406.       colorA3 = *(bP + Nextline + Nextline + 2);
  407.       
  408.       //--------------------------------------
  409.       if (color2 == color6 && color5 != color3) {
  410.         product2b = product1b = color2;
  411.       } else if (color5 == color3 && color2 != color6) {
  412.         product2b = product1b = color5;
  413.       } else if (color5 == color3 && color2 == color6) {
  414.         register int r = 0;
  415.         
  416.         r += GetResult (color6, color5, color1, colorA1);
  417.         r += GetResult (color6, color5, color4, colorB1);
  418.         r += GetResult (color6, color5, colorA2, colorS1);
  419.         r += GetResult (color6, color5, colorB2, colorS2);
  420.         
  421.         if (r > 0)
  422.           product2b = product1b = color6;
  423.         else if (r < 0)
  424.           product2b = product1b = color5;
  425.         else {
  426.           product2b = product1b = INTERPOLATE (color5, color6);
  427.         }
  428.       } else {
  429.         if (color6 == color3 && color3 == colorA1
  430.             && color2 != colorA2 && color3 != colorA0)
  431.           product2b =
  432.             Q_INTERPOLATE (color3, color3, color3, color2);
  433.         else if (color5 == color2 && color2 == colorA2
  434.                  && colorA1 != color3 && color2 != colorA3)
  435.           product2b =
  436.             Q_INTERPOLATE (color2, color2, color2, color3);
  437.         else
  438.           product2b = INTERPOLATE (color2, color3);
  439.         
  440.         if (color6 == color3 && color6 == colorB1
  441.             && color5 != colorB2 && color6 != colorB0)
  442.           product1b =
  443.             Q_INTERPOLATE (color6, color6, color6, color5);
  444.         else if (color5 == color2 && color5 == colorB2
  445.                  && colorB1 != color6 && color5 != colorB3)
  446.           product1b =
  447.             Q_INTERPOLATE (color6, color5, color5, color5);
  448.         else
  449.           product1b = INTERPOLATE (color5, color6);
  450.       }
  451.       
  452.       if (color5 == color3 && color2 != color6 && color4 == color5
  453.           && color5 != colorA2)
  454.         product2a = INTERPOLATE (color2, color5);
  455.       else
  456.         if (color5 == color1 && color6 == color5
  457.             && color4 != color2 && color5 != colorA0)
  458.           product2a = INTERPOLATE (color2, color5);
  459.         else
  460.           product2a = color2;
  461.       
  462.       if (color2 == color6 && color5 != color3 && color1 == color2
  463.           && color2 != colorB2)
  464.         product1a = INTERPOLATE (color2, color5);
  465.       else
  466.         if (color4 == color2 && color3 == color2
  467.             && color1 != color5 && color2 != colorB0)
  468.           product1a = INTERPOLATE (color2, color5);
  469.         else
  470.           product1a = color5;
  471.       *(dP) = product1a;
  472.       *(dP+1) = product1b;
  473.       *(dP + (dstPitch >> 2)) = product2a;
  474.       *(dP + (dstPitch >> 2) + 1) = product2b;
  475.       
  476.       bP += inc_bP;
  477.       dP += 2;
  478.     }                       // end of for ( finish= width etc..)
  479.         
  480.     srcPtr   += srcPitch;
  481.     dstPtr   += dstPitch << 1;
  482.     //        deltaPtr += srcPitch;
  483.   }                 // endof: for (; height; height--)
  484. }
  485.  
  486. void SuperEagle (u8 *srcPtr, u32 srcPitch, u8 *deltaPtr, 
  487.                  u8 *dstPtr, u32 dstPitch, int width, int height)
  488. {
  489.   u8  *dP;
  490.   u16 *bP;
  491.   u16 *xP;
  492.   u32 inc_bP;
  493.  
  494. #ifdef MMX
  495.   if (cpu_mmx) {
  496.     for (; height; height--) {
  497.       _2xSaISuperEagleLine (srcPtr, deltaPtr, srcPitch, width,
  498.                             dstPtr, dstPitch);
  499.       srcPtr += srcPitch;
  500.       dstPtr += dstPitch * 2;
  501.       deltaPtr += srcPitch;
  502.     }
  503.   } else
  504. #endif  
  505.   {
  506.     inc_bP = 1;
  507.     
  508.     u32 Nextline = srcPitch >> 1;
  509.     
  510.     for (; height; height--) {
  511.       bP = (u16 *) srcPtr;
  512.       xP = (u16 *) deltaPtr;
  513.       dP = dstPtr;
  514.       for (u32 finish = width; finish; finish -= inc_bP) {
  515.         u32 color4, color5, color6;
  516.         u32 color1, color2, color3;
  517.         u32 colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
  518.         u32 product1a, product1b, product2a, product2b;
  519.         
  520.         colorB1 = *(bP - Nextline);
  521.         colorB2 = *(bP - Nextline + 1);
  522.         
  523.         color4 = *(bP - 1);
  524.         color5 = *(bP);
  525.         color6 = *(bP + 1);
  526.         colorS2 = *(bP + 2);
  527.         
  528.         color1 = *(bP + Nextline - 1);
  529.         color2 = *(bP + Nextline);
  530.         color3 = *(bP + Nextline + 1);
  531.         colorS1 = *(bP + Nextline + 2);
  532.         
  533.         colorA1 = *(bP + Nextline + Nextline);
  534.         colorA2 = *(bP + Nextline + Nextline + 1);
  535.         
  536.         // --------------------------------------
  537.         if (color2 == color6 && color5 != color3) {
  538.           product1b = product2a = color2;
  539.           if ((color1 == color2) || (color6 == colorB2)) {
  540.             product1a = INTERPOLATE (color2, color5);
  541.             product1a = INTERPOLATE (color2, product1a);
  542.             //                       product1a = color2;
  543.           } else {
  544.             product1a = INTERPOLATE (color5, color6);
  545.           }
  546.           
  547.           if ((color6 == colorS2) || (color2 == colorA1)) {
  548.             product2b = INTERPOLATE (color2, color3);
  549.             product2b = INTERPOLATE (color2, product2b);
  550.             //                       product2b = color2;
  551.           } else {
  552.             product2b = INTERPOLATE (color2, color3);
  553.           }
  554.         } else if (color5 == color3 && color2 != color6) {
  555.           product2b = product1a = color5;
  556.           
  557.           if ((colorB1 == color5) || (color3 == colorS1)) {
  558.             product1b = INTERPOLATE (color5, color6);
  559.             product1b = INTERPOLATE (color5, product1b);
  560.             //                       product1b = color5;
  561.           } else {
  562.             product1b = INTERPOLATE (color5, color6);
  563.           }
  564.           
  565.           if ((color3 == colorA2) || (color4 == color5)) {
  566.             product2a = INTERPOLATE (color5, color2);
  567.             product2a = INTERPOLATE (color5, product2a);
  568.             //                       product2a = color5;
  569.           } else {
  570.             product2a = INTERPOLATE (color2, color3);
  571.           }
  572.           
  573.         } else if (color5 == color3 && color2 == color6) {
  574.           register int r = 0;
  575.           
  576.           r += GetResult (color6, color5, color1, colorA1);
  577.           r += GetResult (color6, color5, color4, colorB1);
  578.           r += GetResult (color6, color5, colorA2, colorS1);
  579.           r += GetResult (color6, color5, colorB2, colorS2);
  580.           
  581.           if (r > 0) {
  582.             product1b = product2a = color2;
  583.             product1a = product2b = INTERPOLATE (color5, color6);
  584.           } else if (r < 0) {
  585.             product2b = product1a = color5;
  586.             product1b = product2a = INTERPOLATE (color5, color6);
  587.           } else {
  588.             product2b = product1a = color5;
  589.             product1b = product2a = color2;
  590.           }
  591.         } else {
  592.           product2b = product1a = INTERPOLATE (color2, color6);
  593.           product2b =
  594.             Q_INTERPOLATE (color3, color3, color3, product2b);
  595.           product1a =
  596.             Q_INTERPOLATE (color5, color5, color5, product1a);
  597.           
  598.           product2a = product1b = INTERPOLATE (color5, color3);
  599.           product2a =
  600.             Q_INTERPOLATE (color2, color2, color2, product2a);
  601.           product1b =
  602.             Q_INTERPOLATE (color6, color6, color6, product1b);
  603.           
  604.           //                    product1a = color5;
  605.           //                    product1b = color6;
  606.           //                    product2a = color2;
  607.           //                    product2b = color3;
  608.         }
  609. #ifdef WORDS_BIGENDIAN
  610.         product1a = (product1a << 16) | product1b;
  611.         product2a = (product2a << 16) | product2b;
  612. #else
  613.         product1a = product1a | (product1b << 16);
  614.         product2a = product2a | (product2b << 16);
  615. #endif
  616.         
  617.         *((u32 *) dP) = product1a;
  618.         *((u32 *) (dP + dstPitch)) = product2a;
  619.         *xP = color5;
  620.         
  621.         bP += inc_bP;
  622.         xP += inc_bP;
  623.         dP += sizeof (u32);
  624.       }                 // end of for ( finish= width etc..)
  625.       
  626.       srcPtr += srcPitch;
  627.       dstPtr += dstPitch << 1;
  628.       deltaPtr += srcPitch;
  629.     }                   // endof: for (height; height; height--)
  630.   }
  631. }
  632.  
  633. void SuperEagle32 (u8 *srcPtr, u32 srcPitch, u8 *deltaPtr, 
  634.                    u8 *dstPtr, u32 dstPitch, int width, int height)
  635. {
  636.   u32  *dP;
  637.   u32 *bP;
  638.   u32 *xP;
  639.   u32 inc_bP;
  640.  
  641.   inc_bP = 1;
  642.   
  643.   u32 Nextline = srcPitch >> 2;
  644.     
  645.   for (; height; height--) {
  646.     bP = (u32 *) srcPtr;
  647.     xP = (u32 *) deltaPtr;
  648.     dP = (u32 *)dstPtr;
  649.     for (u32 finish = width; finish; finish -= inc_bP) {
  650.       u32 color4, color5, color6;
  651.       u32 color1, color2, color3;
  652.       u32 colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
  653.       u32 product1a, product1b, product2a, product2b;
  654.       
  655.       colorB1 = *(bP - Nextline);
  656.       colorB2 = *(bP - Nextline + 1);
  657.       
  658.       color4 = *(bP - 1);
  659.       color5 = *(bP);
  660.       color6 = *(bP + 1);
  661.       colorS2 = *(bP + 2);
  662.       
  663.       color1 = *(bP + Nextline - 1);
  664.       color2 = *(bP + Nextline);
  665.       color3 = *(bP + Nextline + 1);
  666.       colorS1 = *(bP + Nextline + 2);
  667.       
  668.       colorA1 = *(bP + Nextline + Nextline);
  669.       colorA2 = *(bP + Nextline + Nextline + 1);
  670.       
  671.       // --------------------------------------
  672.       if (color2 == color6 && color5 != color3) {
  673.         product1b = product2a = color2;
  674.         if ((color1 == color2) || (color6 == colorB2)) {
  675.           product1a = INTERPOLATE (color2, color5);
  676.           product1a = INTERPOLATE (color2, product1a);
  677.           //                       product1a = color2;
  678.         } else {
  679.           product1a = INTERPOLATE (color5, color6);
  680.         }
  681.         
  682.         if ((color6 == colorS2) || (color2 == colorA1)) {
  683.           product2b = INTERPOLATE (color2, color3);
  684.           product2b = INTERPOLATE (color2, product2b);
  685.           //                       product2b = color2;
  686.         } else {
  687.           product2b = INTERPOLATE (color2, color3);
  688.         }
  689.       } else if (color5 == color3 && color2 != color6) {
  690.         product2b = product1a = color5;
  691.         
  692.         if ((colorB1 == color5) || (color3 == colorS1)) {
  693.           product1b = INTERPOLATE (color5, color6);
  694.           product1b = INTERPOLATE (color5, product1b);
  695.           //                       product1b = color5;
  696.         } else {
  697.           product1b = INTERPOLATE (color5, color6);
  698.         }
  699.         
  700.         if ((color3 == colorA2) || (color4 == color5)) {
  701.           product2a = INTERPOLATE (color5, color2);
  702.           product2a = INTERPOLATE (color5, product2a);
  703.           //                       product2a = color5;
  704.         } else {
  705.           product2a = INTERPOLATE (color2, color3);
  706.         }
  707.         
  708.       } else if (color5 == color3 && color2 == color6) {
  709.         register int r = 0;
  710.         
  711.         r += GetResult (color6, color5, color1, colorA1);
  712.         r += GetResult (color6, color5, color4, colorB1);
  713.         r += GetResult (color6, color5, colorA2, colorS1);
  714.         r += GetResult (color6, color5, colorB2, colorS2);
  715.         
  716.         if (r > 0) {
  717.           product1b = product2a = color2;
  718.           product1a = product2b = INTERPOLATE (color5, color6);
  719.         } else if (r < 0) {
  720.           product2b = product1a = color5;
  721.           product1b = product2a = INTERPOLATE (color5, color6);
  722.         } else {
  723.           product2b = product1a = color5;
  724.           product1b = product2a = color2;
  725.         }
  726.       } else {
  727.         product2b = product1a = INTERPOLATE (color2, color6);
  728.         product2b =
  729.           Q_INTERPOLATE (color3, color3, color3, product2b);
  730.         product1a =
  731.           Q_INTERPOLATE (color5, color5, color5, product1a);
  732.         
  733.         product2a = product1b = INTERPOLATE (color5, color3);
  734.         product2a =
  735.           Q_INTERPOLATE (color2, color2, color2, product2a);
  736.         product1b =
  737.           Q_INTERPOLATE (color6, color6, color6, product1b);
  738.         
  739.         //                    product1a = color5;
  740.         //                    product1b = color6;
  741.         //                    product2a = color2;
  742.         //                    product2b = color3;
  743.       }
  744.       *(dP) = product1a;
  745.       *(dP+1) = product1b;
  746.       *(dP + (dstPitch >> 2)) = product2a;
  747.       *(dP + (dstPitch >> 2) +1) = product2b;
  748.       *xP = color5;
  749.       
  750.       bP += inc_bP;
  751.       xP += inc_bP;
  752.       dP += 2;
  753.     }                 // end of for ( finish= width etc..)
  754.       
  755.     srcPtr += srcPitch;
  756.     dstPtr += dstPitch << 1;
  757.     deltaPtr += srcPitch;
  758.   }                   // endof: for (height; height; height--)
  759. }
  760.  
  761. void _2xSaI (u8 *srcPtr, u32 srcPitch, u8 *deltaPtr,
  762.              u8 *dstPtr, u32 dstPitch, int width, int height)
  763. {
  764.   u8  *dP;
  765.   u16 *bP;
  766.   u32 inc_bP;
  767.   
  768. #ifdef MMX
  769.   if (cpu_mmx) {
  770.     for (; height; height -= 1) {
  771.       _2xSaILine (srcPtr, deltaPtr, srcPitch, width, dstPtr, dstPitch);
  772.       srcPtr += srcPitch;
  773.       dstPtr += dstPitch * 2;
  774.       deltaPtr += srcPitch;
  775.     }
  776.   } else
  777. #endif
  778.   {
  779.     inc_bP = 1;
  780.     
  781.     u32 Nextline = srcPitch >> 1;
  782.     
  783.     for (; height; height--) {
  784.       bP = (u16 *) srcPtr;
  785.       dP = dstPtr;
  786.       
  787.       for (u32 finish = width; finish; finish -= inc_bP) {
  788.         
  789.         register u32 colorA, colorB;
  790.         u32 colorC, colorD,
  791.           colorE, colorF, colorG, colorH,
  792.           colorI, colorJ, colorK, colorL,
  793.           
  794.           colorM, colorN, colorO, colorP;
  795.         u32 product, product1, product2;
  796.         
  797.         //---------------------------------------
  798.         // Map of the pixels:                    I|E F|J
  799.         //                                       G|A B|K
  800.         //                                       H|C D|L
  801.         //                                       M|N O|P
  802.         colorI = *(bP - Nextline - 1);
  803.         colorE = *(bP - Nextline);
  804.         colorF = *(bP - Nextline + 1);
  805.         colorJ = *(bP - Nextline + 2);
  806.         
  807.         colorG = *(bP - 1);
  808.         colorA = *(bP);
  809.         colorB = *(bP + 1);
  810.         colorK = *(bP + 2);
  811.         
  812.         colorH = *(bP + Nextline - 1);
  813.         colorC = *(bP + Nextline);
  814.         colorD = *(bP + Nextline + 1);
  815.         colorL = *(bP + Nextline + 2);
  816.         
  817.         colorM = *(bP + Nextline + Nextline - 1);
  818.         colorN = *(bP + Nextline + Nextline);
  819.         colorO = *(bP + Nextline + Nextline + 1);
  820.         colorP = *(bP + Nextline + Nextline + 2);
  821.         
  822.         if ((colorA == colorD) && (colorB != colorC)) {
  823.           if (((colorA == colorE) && (colorB == colorL)) ||
  824.               ((colorA == colorC) && (colorA == colorF)
  825.                && (colorB != colorE) && (colorB == colorJ))) {
  826.             product = colorA;
  827.           } else {
  828.             product = INTERPOLATE (colorA, colorB);
  829.           }
  830.           
  831.           if (((colorA == colorG) && (colorC == colorO)) ||
  832.               ((colorA == colorB) && (colorA == colorH)
  833.                && (colorG != colorC) && (colorC == colorM))) {
  834.             product1 = colorA;
  835.           } else {
  836.             product1 = INTERPOLATE (colorA, colorC);
  837.           }
  838.           product2 = colorA;
  839.         } else if ((colorB == colorC) && (colorA != colorD)) {
  840.           if (((colorB == colorF) && (colorA == colorH)) ||
  841.               ((colorB == colorE) && (colorB == colorD)
  842.                && (colorA != colorF) && (colorA == colorI))) {
  843.             product = colorB;
  844.           } else {
  845.             product = INTERPOLATE (colorA, colorB);
  846.           }
  847.           
  848.           if (((colorC == colorH) && (colorA == colorF)) ||
  849.               ((colorC == colorG) && (colorC == colorD)
  850.                && (colorA != colorH) && (colorA == colorI))) {
  851.             product1 = colorC;
  852.           } else {
  853.             product1 = INTERPOLATE (colorA, colorC);
  854.           }
  855.           product2 = colorB;
  856.         } else if ((colorA == colorD) && (colorB == colorC)) {
  857.           if (colorA == colorB) {
  858.             product = colorA;
  859.             product1 = colorA;
  860.             product2 = colorA;
  861.           } else {
  862.             register int r = 0;
  863.             
  864.             product1 = INTERPOLATE (colorA, colorC);
  865.             product = INTERPOLATE (colorA, colorB);
  866.             
  867.             r +=
  868.               GetResult1 (colorA, colorB, colorG, colorE,
  869.                           colorI);
  870.             r +=
  871.               GetResult2 (colorB, colorA, colorK, colorF,
  872.                           colorJ);
  873.             r +=
  874.               GetResult2 (colorB, colorA, colorH, colorN,
  875.                           colorM);
  876.             r +=
  877.               GetResult1 (colorA, colorB, colorL, colorO,
  878.                           colorP);
  879.             
  880.             if (r > 0)
  881.               product2 = colorA;
  882.             else if (r < 0)
  883.               product2 = colorB;
  884.             else {
  885.               product2 =
  886.                 Q_INTERPOLATE (colorA, colorB, colorC,
  887.                                colorD);
  888.             }
  889.           }
  890.         } else {
  891.           product2 = Q_INTERPOLATE (colorA, colorB, colorC, colorD);
  892.           
  893.           if ((colorA == colorC) && (colorA == colorF)
  894.               && (colorB != colorE) && (colorB == colorJ)) {
  895.             product = colorA;
  896.           } else if ((colorB == colorE) && (colorB == colorD)
  897.                      && (colorA != colorF) && (colorA == colorI)) {
  898.             product = colorB;
  899.           } else {
  900.             product = INTERPOLATE (colorA, colorB);
  901.           }
  902.           
  903.           if ((colorA == colorB) && (colorA == colorH)
  904.               && (colorG != colorC) && (colorC == colorM)) {
  905.             product1 = colorA;
  906.           } else if ((colorC == colorG) && (colorC == colorD)
  907.                      && (colorA != colorH) && (colorA == colorI)) {
  908.             product1 = colorC;
  909.           } else {
  910.             product1 = INTERPOLATE (colorA, colorC);
  911.           }
  912.         }
  913.         
  914. #ifdef WORDS_BIGENDIAN
  915.         product = (colorA << 16) | product ;
  916.         product1 = (product1 << 16) | product2 ;
  917. #else
  918.         product = colorA | (product << 16);
  919.         product1 = product1 | (product2 << 16);
  920. #endif
  921.         *((s32 *) dP) = product;
  922.         *((u32 *) (dP + dstPitch)) = product1;
  923.         
  924.         bP += inc_bP;
  925.         dP += sizeof (u32);
  926.       }                 // end of for ( finish= width etc..)
  927.       
  928.       srcPtr += srcPitch;
  929.       dstPtr += dstPitch << 1;
  930.       deltaPtr += srcPitch;
  931.     }                   // endof: for (height; height; height--)
  932.   }
  933. }
  934.  
  935. void _2xSaI32 (u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,
  936.                u8 *dstPtr, u32 dstPitch, int width, int height)
  937. {
  938.   u32  *dP;
  939.   u32 *bP;
  940.   u32 inc_bP = 1;
  941.     
  942.   u32 Nextline = srcPitch >> 2;
  943.     
  944.   for (; height; height--) {
  945.     bP = (u32 *) srcPtr;
  946.     dP = (u32 *) dstPtr;
  947.       
  948.     for (u32 finish = width; finish; finish -= inc_bP) {
  949.       register u32 colorA, colorB;
  950.       u32 colorC, colorD,
  951.         colorE, colorF, colorG, colorH,
  952.         colorI, colorJ, colorK, colorL,
  953.         
  954.         colorM, colorN, colorO, colorP;
  955.       u32 product, product1, product2;
  956.       
  957.       //---------------------------------------
  958.       // Map of the pixels:                    I|E F|J
  959.       //                                       G|A B|K
  960.       //                                       H|C D|L
  961.       //                                       M|N O|P
  962.       colorI = *(bP - Nextline - 1);
  963.       colorE = *(bP - Nextline);
  964.       colorF = *(bP - Nextline + 1);
  965.       colorJ = *(bP - Nextline + 2);
  966.         
  967.       colorG = *(bP - 1);
  968.       colorA = *(bP);
  969.       colorB = *(bP + 1);
  970.       colorK = *(bP + 2);
  971.         
  972.       colorH = *(bP + Nextline - 1);
  973.       colorC = *(bP + Nextline);
  974.       colorD = *(bP + Nextline + 1);
  975.       colorL = *(bP + Nextline + 2);
  976.       
  977.       colorM = *(bP + Nextline + Nextline - 1);
  978.       colorN = *(bP + Nextline + Nextline);
  979.       colorO = *(bP + Nextline + Nextline + 1);
  980.       colorP = *(bP + Nextline + Nextline + 2);
  981.       
  982.       if ((colorA == colorD) && (colorB != colorC)) {
  983.         if (((colorA == colorE) && (colorB == colorL)) ||
  984.             ((colorA == colorC) && (colorA == colorF)
  985.              && (colorB != colorE) && (colorB == colorJ))) {
  986.           product = colorA;
  987.         } else {
  988.           product = INTERPOLATE (colorA, colorB);
  989.         }
  990.           
  991.         if (((colorA == colorG) && (colorC == colorO)) ||
  992.             ((colorA == colorB) && (colorA == colorH)
  993.              && (colorG != colorC) && (colorC == colorM))) {
  994.           product1 = colorA;
  995.         } else {
  996.           product1 = INTERPOLATE (colorA, colorC);
  997.         }
  998.         product2 = colorA;
  999.       } else if ((colorB == colorC) && (colorA != colorD)) {
  1000.         if (((colorB == colorF) && (colorA == colorH)) ||
  1001.             ((colorB == colorE) && (colorB == colorD)
  1002.              && (colorA != colorF) && (colorA == colorI))) {
  1003.           product = colorB;
  1004.         } else {
  1005.           product = INTERPOLATE (colorA, colorB);
  1006.         }
  1007.         
  1008.         if (((colorC == colorH) && (colorA == colorF)) ||
  1009.             ((colorC == colorG) && (colorC == colorD)
  1010.              && (colorA != colorH) && (colorA == colorI))) {
  1011.           product1 = colorC;
  1012.         } else {
  1013.           product1 = INTERPOLATE (colorA, colorC);
  1014.         }
  1015.         product2 = colorB;
  1016.       } else if ((colorA == colorD) && (colorB == colorC)) {
  1017.         if (colorA == colorB) {
  1018.           product = colorA;
  1019.           product1 = colorA;
  1020.           product2 = colorA;
  1021.         } else {
  1022.           register int r = 0;
  1023.           
  1024.           product1 = INTERPOLATE (colorA, colorC);
  1025.           product = INTERPOLATE (colorA, colorB);
  1026.           
  1027.           r +=
  1028.             GetResult1 (colorA, colorB, colorG, colorE,
  1029.                         colorI);
  1030.           r +=
  1031.             GetResult2 (colorB, colorA, colorK, colorF,
  1032.                         colorJ);
  1033.           r +=
  1034.             GetResult2 (colorB, colorA, colorH, colorN,
  1035.                            colorM);
  1036.           r +=
  1037.             GetResult1 (colorA, colorB, colorL, colorO,
  1038.                            colorP);
  1039.             
  1040.           if (r > 0)
  1041.             product2 = colorA;
  1042.           else if (r < 0)
  1043.             product2 = colorB;
  1044.           else {
  1045.             product2 =
  1046.               Q_INTERPOLATE (colorA, colorB, colorC,
  1047.                                colorD);
  1048.             }
  1049.         }
  1050.       } else {
  1051.         product2 = Q_INTERPOLATE (colorA, colorB, colorC, colorD);
  1052.         
  1053.         if ((colorA == colorC) && (colorA == colorF)
  1054.             && (colorB != colorE) && (colorB == colorJ)) {
  1055.           product = colorA;
  1056.         } else if ((colorB == colorE) && (colorB == colorD)
  1057.                    && (colorA != colorF) && (colorA == colorI)) {
  1058.           product = colorB;
  1059.         } else {
  1060.           product = INTERPOLATE (colorA, colorB);
  1061.         }
  1062.         
  1063.         if ((colorA == colorB) && (colorA == colorH)
  1064.             && (colorG != colorC) && (colorC == colorM)) {
  1065.           product1 = colorA;
  1066.         } else if ((colorC == colorG) && (colorC == colorD)
  1067.                    && (colorA != colorH) && (colorA == colorI)) {
  1068.           product1 = colorC;
  1069.         } else {
  1070.           product1 = INTERPOLATE (colorA, colorC);
  1071.         }
  1072.       }
  1073.       *(dP) = colorA;
  1074.       *(dP + 1) = product;
  1075.       *(dP + (dstPitch >> 2)) = product1;
  1076.       *(dP + (dstPitch >> 2) + 1) = product2;
  1077.       
  1078.       bP += inc_bP;
  1079.       dP += 2;
  1080.     }                 // end of for ( finish= width etc..)
  1081.     
  1082.     srcPtr += srcPitch;
  1083.     dstPtr += dstPitch << 1;
  1084.     //    deltaPtr += srcPitch;
  1085.   }                   // endof: for (height; height; height--)
  1086. }
  1087.  
  1088. static u32 Bilinear (u32 A, u32 B, u32 x)
  1089. {
  1090.   unsigned long areaA, areaB;
  1091.   unsigned long result;
  1092.   
  1093.   if (A == B)
  1094.     return A;
  1095.   
  1096.   areaB = (x >> 11) & 0x1f;     // reduce 16 bit fraction to 5 bits
  1097.   areaA = 0x20 - areaB;
  1098.   
  1099.   A = (A & redblueMask) | ((A & greenMask) << 16);
  1100.   B = (B & redblueMask) | ((B & greenMask) << 16);
  1101.   
  1102.   result = ((areaA * A) + (areaB * B)) >> 5;
  1103.   
  1104.   return (result & redblueMask) | ((result >> 16) & greenMask);
  1105. }
  1106.  
  1107. static u32 Bilinear4 (u32 A, u32 B, u32 C, u32 D, u32 x,
  1108.                          u32 y)
  1109. {
  1110.   unsigned long areaA, areaB, areaC, areaD;
  1111.   unsigned long result, xy;
  1112.   
  1113.   x = (x >> 11) & 0x1f;
  1114.   y = (y >> 11) & 0x1f;
  1115.   xy = (x * y) >> 5;
  1116.   
  1117.   A = (A & redblueMask) | ((A & greenMask) << 16);
  1118.   B = (B & redblueMask) | ((B & greenMask) << 16);
  1119.   C = (C & redblueMask) | ((C & greenMask) << 16);
  1120.   D = (D & redblueMask) | ((D & greenMask) << 16);
  1121.   
  1122.   areaA = 0x20 + xy - x - y;
  1123.   areaB = x - xy;
  1124.   areaC = y - xy;
  1125.   areaD = xy;
  1126.   
  1127.   result = ((areaA * A) + (areaB * B) + (areaC * C) + (areaD * D)) >> 5;
  1128.   
  1129.   return (result & redblueMask) | ((result >> 16) & greenMask);
  1130. }
  1131.  
  1132. void Scale_2xSaI (u8 *srcPtr, u32 srcPitch, u8 * /* deltaPtr */,
  1133.                   u8 *dstPtr, u32 dstPitch, 
  1134.                   u32 dstWidth, u32 dstHeight, int width, int height)
  1135. {
  1136.   u8  *dP;
  1137.   u16 *bP;
  1138.  
  1139.   u32 w;
  1140.   u32 h;
  1141.   u32 dw;
  1142.   u32 dh;
  1143.   u32 hfinish;
  1144.   u32 wfinish;
  1145.   
  1146.   u32 Nextline = srcPitch >> 1;
  1147.   
  1148.   wfinish = (width - 1) << 16;  // convert to fixed point
  1149.   dw = wfinish / (dstWidth - 1);
  1150.   hfinish = (height - 1) << 16; // convert to fixed point
  1151.   dh = hfinish / (dstHeight - 1);
  1152.   
  1153.   for (h = 0; h < hfinish; h += dh) {
  1154.     u32 y1, y2;
  1155.     
  1156.     y1 = h & 0xffff;    // fraction part of fixed point
  1157.     bP = (u16 *) (srcPtr + ((h >> 16) * srcPitch));
  1158.     dP = dstPtr;
  1159.     y2 = 0x10000 - y1;
  1160.     
  1161.     w = 0;
  1162.     
  1163.     for (; w < wfinish;) {
  1164.       u32 A, B, C, D;
  1165.       u32 E, F, G, H;
  1166.       u32 I, J, K, L;
  1167.       u32 x1, x2, a1, f1, f2;
  1168.       u32 position, product1;
  1169.       
  1170.       position = w >> 16;
  1171.       A = bP[position]; // current pixel
  1172.       B = bP[position + 1];     // next pixel
  1173.       C = bP[position + Nextline];
  1174.       D = bP[position + Nextline + 1];
  1175.       E = bP[position - Nextline];
  1176.       F = bP[position - Nextline + 1];
  1177.       G = bP[position - 1];
  1178.       H = bP[position + Nextline - 1];
  1179.       I = bP[position + 2];
  1180.       J = bP[position + Nextline + 2];
  1181.       K = bP[position + Nextline + Nextline];
  1182.       L = bP[position + Nextline + Nextline + 1];
  1183.       
  1184.       x1 = w & 0xffff;  // fraction part of fixed point
  1185.       x2 = 0x10000 - x1;
  1186.       
  1187.       /*0*/ 
  1188.       if (A == B && C == D && A == C)
  1189.         product1 = A;
  1190.       else /*1*/ if (A == D && B != C) {
  1191.         f1 = (x1 >> 1) + (0x10000 >> 2);
  1192.         f2 = (y1 >> 1) + (0x10000 >> 2);
  1193.         if (y1 <= f1 && A == J && A != E)       // close to B
  1194.           {
  1195.             a1 = f1 - y1;
  1196.             product1 = Bilinear (A, B, a1);
  1197.           } else if (y1 >= f1 && A == G && A != L)      // close to C
  1198.             {
  1199.               a1 = y1 - f1;
  1200.               product1 = Bilinear (A, C, a1);
  1201.             }
  1202.         else if (x1 >= f2 && A == E && A != J)  // close to B
  1203.           {
  1204.             a1 = x1 - f2;
  1205.             product1 = Bilinear (A, B, a1);
  1206.           }
  1207.         else if (x1 <= f2 && A == L && A != G)  // close to C
  1208.           {
  1209.             a1 = f2 - x1;
  1210.             product1 = Bilinear (A, C, a1);
  1211.           }
  1212.         else if (y1 >= x1)      // close to C
  1213.           {
  1214.             a1 = y1 - x1;
  1215.             product1 = Bilinear (A, C, a1);
  1216.           }
  1217.         else if (y1 <= x1)      // close to B
  1218.           {
  1219.             a1 = x1 - y1;
  1220.             product1 = Bilinear (A, B, a1);
  1221.           }
  1222.       }
  1223.       else
  1224.         /*2*/ 
  1225.         if (B == C && A != D)
  1226.           {
  1227.             f1 = (x1 >> 1) + (0x10000 >> 2);
  1228.             f2 = (y1 >> 1) + (0x10000 >> 2);
  1229.             if (y2 >= f1 && B == H && B != F)   // close to A
  1230.               {
  1231.                 a1 = y2 - f1;
  1232.                 product1 = Bilinear (B, A, a1);
  1233.               }
  1234.             else if (y2 <= f1 && B == I && B != K)      // close to D
  1235.               {
  1236.                 a1 = f1 - y2;
  1237.                 product1 = Bilinear (B, D, a1);
  1238.               }
  1239.             else if (x2 >= f2 && B == F && B != H)      // close to A
  1240.               {
  1241.                 a1 = x2 - f2;
  1242.                 product1 = Bilinear (B, A, a1);
  1243.               }
  1244.             else if (x2 <= f2 && B == K && B != I)      // close to D
  1245.               {
  1246.                 a1 = f2 - x2;
  1247.                 product1 = Bilinear (B, D, a1);
  1248.               }
  1249.             else if (y2 >= x1)  // close to A
  1250.               {
  1251.                 a1 = y2 - x1;
  1252.                 product1 = Bilinear (B, A, a1);
  1253.               }
  1254.             else if (y2 <= x1)  // close to D
  1255.               {
  1256.                 a1 = x1 - y2;
  1257.                 product1 = Bilinear (B, D, a1);
  1258.               }
  1259.           }
  1260.       /*3*/
  1261.         else
  1262.           {
  1263.             product1 = Bilinear4 (A, B, C, D, x1, y1);
  1264.           }
  1265.       
  1266.       //end First Pixel
  1267.       *(u32 *) dP = product1;
  1268.       dP += 2;
  1269.       w += dw;
  1270.     }
  1271.     dstPtr += dstPitch;
  1272.   }
  1273. }
  1274.  
  1275.