source/gles2rice/src/TextureFilters_hq2x.cpp

   1 /* * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * *
   2  *   Mupen64plus - TextureFilters_hq2x.cpp                                 *
   3  *   Mupen64Plus homepage: http://code.google.com/p/mupen64plus/           *
   4  *   Copyright (C) 2003 MaxSt ( maxst@hiend3d.com )                        *
   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                         *
  18  *   Free Software Foundation, Inc.,                                       *
  19  *   51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.          *
  20  * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * */
  21
  22 #include "typedefs.h"
  23
  24 /************************************************************************/
  25 /* hq2x filters                                                         */
  26 /************************************************************************/
  27
  28 /***************************************************************************/
  29 /* Basic types */
  30
  31 /***************************************************************************/
  32 /* interpolation */
  33
  34 static unsigned interp_bits_per_pixel;
  35
  36 #define INTERP_16_MASK_1_3(v) ((v)&0x0F0F)
  37 #define INTERP_16_MASK_SHIFT_2_4(v) (((v)&0xF0F0)>>4)
  38 #define INTERP_16_MASK_SHIFTBACK_2_4(v) ((INTERP_16_MASK_1_3(v))<<4)
  39
  40 static inline uint16 hq2x_interp_16_521(uint16 p1, uint16 p2, uint16 p3)
  41 {
  42     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*5 + INTERP_16_MASK_1_3(p2)*2 + INTERP_16_MASK_1_3(p3)*1) / 8)
  43         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*5 + INTERP_16_MASK_SHIFT_2_4(p2)*2 + INTERP_16_MASK_SHIFT_2_4(p3)*1) / 8);
  44 }
  45
  46 static inline uint16 hq2x_interp_16_332(uint16 p1, uint16 p2, uint16 p3)
  47 {
  48     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*3 + INTERP_16_MASK_1_3(p2)*3 + INTERP_16_MASK_1_3(p3)*2) / 8)
  49         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*3 + INTERP_16_MASK_SHIFT_2_4(p2)*3 + INTERP_16_MASK_SHIFT_2_4(p3)*2) / 8);
  50 }
  51
  52 static inline uint16 hq2x_interp_16_611(uint16 p1, uint16 p2, uint16 p3)
  53 {
  54     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*6 + INTERP_16_MASK_1_3(p2) + INTERP_16_MASK_1_3(p3)) / 8)
  55         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*6 + INTERP_16_MASK_SHIFT_2_4(p2) + INTERP_16_MASK_SHIFT_2_4(p3)) / 8);
  56 }
  57
  58 static inline uint16 hq2x_interp_16_71(uint16 p1, uint16 p2)
  59 {
  60     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*7 + INTERP_16_MASK_1_3(p2)) / 8)
  61         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*7 + INTERP_16_MASK_SHIFT_2_4(p2)) / 8);
  62 }
  63
  64 static inline uint16 hq2x_interp_16_211(uint16 p1, uint16 p2, uint16 p3)
  65 {
  66     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*2 + INTERP_16_MASK_1_3(p2) + INTERP_16_MASK_1_3(p3)) / 4)
  67         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*2 + INTERP_16_MASK_SHIFT_2_4(p2) + INTERP_16_MASK_SHIFT_2_4(p3)) / 4);
  68 }
  69
  70 static inline uint16 hq2x_interp_16_772(uint16 p1, uint16 p2, uint16 p3)
  71 {
  72     return INTERP_16_MASK_1_3(((INTERP_16_MASK_1_3(p1) + INTERP_16_MASK_1_3(p2))*7 + INTERP_16_MASK_1_3(p3)*2) / 16)
  73         | INTERP_16_MASK_SHIFTBACK_2_4(((INTERP_16_MASK_SHIFT_2_4(p1) + INTERP_16_MASK_SHIFT_2_4(p2))*7 + INTERP_16_MASK_SHIFT_2_4(p3)*2) / 16);
  74 }
  75
  76 static inline uint16 hq2x_interp_16_11(uint16 p1, uint16 p2)
  77 {
  78     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1) + INTERP_16_MASK_1_3(p2)) / 2)
  79         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1) + INTERP_16_MASK_SHIFT_2_4(p2)) / 2);
  80 }
  81
  82 static inline uint16 hq2x_interp_16_31(uint16 p1, uint16 p2)
  83 {
  84     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*3 + INTERP_16_MASK_1_3(p2)) / 4)
  85         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*3 + INTERP_16_MASK_SHIFT_2_4(p2)) / 4);
  86 }
  87
  88 static inline uint16 hq2x_interp_16_1411(uint16 p1, uint16 p2, uint16 p3)
  89 {
  90     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*14 + INTERP_16_MASK_1_3(p2) + INTERP_16_MASK_1_3(p3)) / 16)
  91         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*14 + INTERP_16_MASK_SHIFT_2_4(p2) + INTERP_16_MASK_SHIFT_2_4(p3)) / 16);
  92 }
  93
  94 static inline uint16 hq2x_interp_16_431(uint16 p1, uint16 p2, uint16 p3)
  95 {
  96     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*4 + INTERP_16_MASK_1_3(p2)*3 + INTERP_16_MASK_1_3(p3)) / 8)
  97         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*4 + INTERP_16_MASK_SHIFT_2_4(p2)*3 + INTERP_16_MASK_SHIFT_2_4(p3)) / 8);
  98 }
  99
 100 static inline uint16 hq2x_interp_16_53(uint16 p1, uint16 p2)
 101 {
 102     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*5 + INTERP_16_MASK_1_3(p2)*3) / 8)
 103         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*5 + INTERP_16_MASK_SHIFT_2_4(p2)*3) / 8);
 104 }
 105
 106 static inline uint16 hq2x_interp_16_151(uint16 p1, uint16 p2)
 107 {
 108     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*15 + INTERP_16_MASK_1_3(p2)) / 16)
 109         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*15 + INTERP_16_MASK_SHIFT_2_4(p2)) / 16);
 110 }
 111
 112 static inline uint16 hq2x_interp_16_97(uint16 p1, uint16 p2)
 113 {
 114     return INTERP_16_MASK_1_3((INTERP_16_MASK_1_3(p1)*9 + INTERP_16_MASK_1_3(p2)*7) / 16)
 115         | INTERP_16_MASK_SHIFTBACK_2_4((INTERP_16_MASK_SHIFT_2_4(p1)*9 + INTERP_16_MASK_SHIFT_2_4(p2)*7) / 16);
 116 }
 117
 118 #define INTERP_32_MASK_1_3(v) ((v)&0x00FF00FF)
 119 #define INTERP_32_MASK_SHIFT_2_4(v) (((v)&0xFF00FF00)>>8)
 120 #define INTERP_32_MASK_SHIFTBACK_2_4(v) (((INTERP_32_MASK_1_3(v))<<8))
 121
 122 static inline uint32 hq2x_interp_32_521(uint32 p1, uint32 p2, uint32 p3)
 123 {
 124     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*5 + INTERP_32_MASK_1_3(p2)*2 + INTERP_32_MASK_1_3(p3)*1) / 8)
 125         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*5 + INTERP_32_MASK_SHIFT_2_4(p2)*2 + INTERP_32_MASK_SHIFT_2_4(p3)*1) / 8);
 126 }
 127
 128 static inline uint32 hq2x_interp_32_332(uint32 p1, uint32 p2, uint32 p3)
 129 {
 130     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*3 + INTERP_32_MASK_1_3(p2)*3 + INTERP_32_MASK_1_3(p3)*2) / 8)
 131         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*3 + INTERP_32_MASK_SHIFT_2_4(p2)*3 + INTERP_32_MASK_SHIFT_2_4(p3)*2) / 8);
 132 }
 133
 134 static inline uint32 hq2x_interp_32_211(uint32 p1, uint32 p2, uint32 p3)
 135 {
 136     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*2 + INTERP_32_MASK_1_3(p2) + INTERP_32_MASK_1_3(p3)) / 4)
 137         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*2 + INTERP_32_MASK_SHIFT_2_4(p2) + INTERP_32_MASK_SHIFT_2_4(p3)) / 4);
 138 }
 139
 140 static inline uint32 hq2x_interp_32_611(uint32 p1, uint32 p2, uint32 p3)
 141 {
 142     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*6 + INTERP_32_MASK_1_3(p2) + INTERP_32_MASK_1_3(p3)) / 8)
 143         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*6 + INTERP_32_MASK_SHIFT_2_4(p2) + INTERP_32_MASK_SHIFT_2_4(p3)) / 8);
 144 }
 145
 146 static inline uint32 hq2x_interp_32_71(uint32 p1, uint32 p2)
 147 {
 148     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*7 + INTERP_32_MASK_1_3(p2)) / 8)
 149         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*7 + INTERP_32_MASK_SHIFT_2_4(p2)) / 8);
 150 }
 151
 152 static inline uint32 hq2x_interp_32_772(uint32 p1, uint32 p2, uint32 p3)
 153 {
 154     return INTERP_32_MASK_1_3(((INTERP_32_MASK_1_3(p1) + INTERP_32_MASK_1_3(p2))*7 + INTERP_32_MASK_1_3(p3)*2) / 16)
 155         | INTERP_32_MASK_SHIFTBACK_2_4(((INTERP_32_MASK_SHIFT_2_4(p1) + INTERP_32_MASK_SHIFT_2_4(p2))*7 + INTERP_32_MASK_SHIFT_2_4(p3)*2) / 16);
 156 }
 157
 158 static inline uint32 hq2x_interp_32_11(uint32 p1, uint32 p2)
 159 {
 160     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1) + INTERP_32_MASK_1_3(p2)) / 2)
 161         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1) + INTERP_32_MASK_SHIFT_2_4(p2)) / 2);
 162 }
 163
 164 static inline uint32 hq2x_interp_32_31(uint32 p1, uint32 p2)
 165 {
 166     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*3 + INTERP_32_MASK_1_3(p2)) / 4)
 167         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*3 + INTERP_32_MASK_SHIFT_2_4(p2)) / 4);
 168 }
 169
 170 static inline uint32 hq2x_interp_32_1411(uint32 p1, uint32 p2, uint32 p3)
 171 {
 172     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*14 + INTERP_32_MASK_1_3(p2) + INTERP_32_MASK_1_3(p3)) / 16)
 173         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*14 + INTERP_32_MASK_SHIFT_2_4(p2) + INTERP_32_MASK_SHIFT_2_4(p3)) / 16);
 174 }
 175
 176 static inline uint32 hq2x_interp_32_431(uint32 p1, uint32 p2, uint32 p3)
 177 {
 178     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*4 + INTERP_32_MASK_1_3(p2)*3 + INTERP_32_MASK_1_3(p3)) / 8)
 179         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*4 + INTERP_32_MASK_SHIFT_2_4(p2)*3 + INTERP_32_MASK_SHIFT_2_4(p3)) / 8);
 180 }
 181
 182 static inline uint32 hq2x_interp_32_53(uint32 p1, uint32 p2)
 183 {
 184     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*5 + INTERP_32_MASK_1_3(p2)*3) / 8)
 185         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*5 + INTERP_32_MASK_SHIFT_2_4(p2)*3) / 8);
 186 }
 187
 188 static inline uint32 hq2x_interp_32_151(uint32 p1, uint32 p2)
 189 {
 190     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*15 + INTERP_32_MASK_1_3(p2)) / 16)
 191         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*15 + INTERP_32_MASK_SHIFT_2_4(p2)) / 16);
 192 }
 193
 194 static inline uint32 hq2x_interp_32_97(uint32 p1, uint32 p2)
 195 {
 196     return INTERP_32_MASK_1_3((INTERP_32_MASK_1_3(p1)*9 + INTERP_32_MASK_1_3(p2)*7) / 16)
 197         | INTERP_32_MASK_SHIFTBACK_2_4((INTERP_32_MASK_SHIFT_2_4(p1)*9 + INTERP_32_MASK_SHIFT_2_4(p2)*7) / 16);
 198 }
 199
 200 /***************************************************************************/
 201 /* diff */
 202
 203 #define INTERP_Y_LIMIT (0x30*4)
 204 #define INTERP_U_LIMIT (0x07*4)
 205 #define INTERP_V_LIMIT (0x06*8)
 206
 207 static int hq2x_interp_16_diff(uint16 p1, uint16 p2)
 208 {
 209     int r, g, b;
 210     int y, u, v;
 211
 212     if (p1 == p2)
 213         return 0;
 214
 215     b = (int)((p1 & 0x000F) - (p2 & 0x000F));
 216     g = (int)((p1 & 0x00F0) - (p2 & 0x00F0)) >> 4;
 217     r = (int)((p1 & 0x0F00) - (p2 & 0x0F00)) >> 8;
 218
 219     y = r + g + b;
 220     u = r - b;
 221     v = -r + 2*g - b;
 222
 223     if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT)
 224         return 1;
 225
 226     if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT)
 227         return 1;
 228
 229     if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT)
 230         return 1;
 231
 232     return 0;
 233 }
 234
 235 static int hq2x_interp_32_diff(uint32 p1, uint32 p2)
 236 {
 237     int r, g, b;
 238     int y, u, v;
 239
 240     if ((p1 & 0xF8F8F8) == (p2 & 0xF8F8F8))
 241         return 0;
 242
 243     b = (int)((p1 & 0xFF) - (p2 & 0xFF));
 244     g = (int)((p1 & 0xFF00) - (p2 & 0xFF00)) >> 8;
 245     r = (int)((p1 & 0xFF0000) - (p2 & 0xFF0000)) >> 16;
 246
 247     y = r + g + b;
 248     u = r - b;
 249     v = -r + 2*g - b;
 250
 251     if (y < -INTERP_Y_LIMIT || y > INTERP_Y_LIMIT)
 252         return 1;
 253
 254     if (u < -INTERP_U_LIMIT || u > INTERP_U_LIMIT)
 255         return 1;
 256
 257     if (v < -INTERP_V_LIMIT || v > INTERP_V_LIMIT)
 258         return 1;
 259
 260     return 0;
 261 }
 262
 263 static void interp_set(unsigned bits_per_pixel)
 264 {
 265     interp_bits_per_pixel = bits_per_pixel;
 266 }
 267
 268
 269 static void hq2x_16_def(uint16* dst0, uint16* dst1, const uint16* src0, const uint16* src1, const uint16* src2, unsigned count)
 270 {
 271     unsigned i;
 272
 273     for(i=0;i<count;++i) {
 274         unsigned char mask;
 275
 276         uint16 c[9];
 277
 278         c[1] = src0[0];
 279         c[4] = src1[0];
 280         c[7] = src2[0];
 281
 282         if (i>0) {
 283             c[0] = src0[-1];
 284             c[3] = src1[-1];
 285             c[6] = src2[-1];
 286         } else {
 287             c[0] = c[1];
 288             c[3] = c[4];
 289             c[6] = c[7];
 290         }
 291
 292         if (i<count-1) {
 293             c[2] = src0[1];
 294             c[5] = src1[1];
 295             c[8] = src2[1];
 296         } else {
 297             c[2] = c[1];
 298             c[5] = c[4];
 299             c[8] = c[7];
 300         }
 301
 302         mask = 0;
 303
 304         if (hq2x_interp_16_diff(c[0], c[4]))
 305             mask |= 1 << 0;
 306         if (hq2x_interp_16_diff(c[1], c[4]))
 307             mask |= 1 << 1;
 308         if (hq2x_interp_16_diff(c[2], c[4]))
 309             mask |= 1 << 2;
 310         if (hq2x_interp_16_diff(c[3], c[4]))
 311             mask |= 1 << 3;
 312         if (hq2x_interp_16_diff(c[5], c[4]))
 313             mask |= 1 << 4;
 314         if (hq2x_interp_16_diff(c[6], c[4]))
 315             mask |= 1 << 5;
 316         if (hq2x_interp_16_diff(c[7], c[4]))
 317             mask |= 1 << 6;
 318         if (hq2x_interp_16_diff(c[8], c[4]))
 319             mask |= 1 << 7;
 320
 321 #define P0 dst0[0]
 322 #define P1 dst0[1]
 323 #define P2 dst1[0]
 324 #define P3 dst1[1]
 325 #define HQ2X_MUR hq2x_interp_16_diff(c[1], c[5])
 326 #define HQ2X_MDR hq2x_interp_16_diff(c[5], c[7])
 327 #define HQ2X_MDL hq2x_interp_16_diff(c[7], c[3])
 328 #define HQ2X_MUL hq2x_interp_16_diff(c[3], c[1])
 329 #define IC(p0) c[p0]
 330 #define I11(p0,p1) hq2x_interp_16_11(c[p0], c[p1])
 331 #define I211(p0,p1,p2) hq2x_interp_16_211(c[p0], c[p1], c[p2])
 332 #define I31(p0,p1) hq2x_interp_16_31(c[p0], c[p1])
 333 #define I332(p0,p1,p2) hq2x_interp_16_332(c[p0], c[p1], c[p2])
 334 #define I431(p0,p1,p2) hq2x_interp_16_431(c[p0], c[p1], c[p2])
 335 #define I521(p0,p1,p2) hq2x_interp_16_521(c[p0], c[p1], c[p2])
 336 #define I53(p0,p1) hq2x_interp_16_53(c[p0], c[p1])
 337 #define I611(p0,p1,p2) hq2x_interp_16_611(c[p0], c[p1], c[p2])
 338 #define I71(p0,p1) hq2x_interp_16_71(c[p0], c[p1])
 339 #define I772(p0,p1,p2) hq2x_interp_16_772(c[p0], c[p1], c[p2])
 340 #define I97(p0,p1) hq2x_interp_16_97(c[p0], c[p1])
 341 #define I1411(p0,p1,p2) hq2x_interp_16_1411(c[p0], c[p1], c[p2])
 342 #define I151(p0,p1) hq2x_interp_16_151(c[p0], c[p1])
 343
 344         switch (mask) {
 345 #include "TextureFilters_hq2x.h"
 346         }
 347
 348 #undef P0
 349 #undef P1
 350 #undef P2
 351 #undef P3
 352 #undef HQ2X_MUR
 353 #undef HQ2X_MDR
 354 #undef HQ2X_MDL
 355 #undef HQ2X_MUL
 356 #undef IC
 357 #undef I11
 358 #undef I211
 359 #undef I31
 360 #undef I332
 361 #undef I431
 362 #undef I521
 363 #undef I53
 364 #undef I611
 365 #undef I71
 366 #undef I772
 367 #undef I97
 368 #undef I1411
 369 #undef I151
 370
 371         src0 += 1;
 372         src1 += 1;
 373         src2 += 1;
 374         dst0 += 2;
 375         dst1 += 2;
 376     }
 377 }
 378
 379 static void hq2x_32_def(uint32* dst0, uint32* dst1, const uint32* src0, const uint32* src1, const uint32* src2, unsigned count)
 380 {
 381     unsigned i;
 382
 383     for(i=0;i<count;++i) {
 384         unsigned char mask;
 385
 386         uint32 c[9];
 387
 388         c[1] = src0[0];
 389         c[4] = src1[0];
 390         c[7] = src2[0];
 391
 392         if (i>0) {
 393             c[0] = src0[-1];
 394             c[3] = src1[-1];
 395             c[6] = src2[-1];
 396         } else {
 397             c[0] = src0[0];
 398             c[3] = src1[0];
 399             c[6] = src2[0];
 400         }
 401
 402         if (i<count-1) {
 403             c[2] = src0[1];
 404             c[5] = src1[1];
 405             c[8] = src2[1];
 406         } else {
 407             c[2] = src0[0];
 408             c[5] = src1[0];
 409             c[8] = src2[0];
 410         }
 411
 412         mask = 0;
 413
 414         if (hq2x_interp_32_diff(c[0], c[4]))
 415             mask |= 1 << 0;
 416         if (hq2x_interp_32_diff(c[1], c[4]))
 417             mask |= 1 << 1;
 418         if (hq2x_interp_32_diff(c[2], c[4]))
 419             mask |= 1 << 2;
 420         if (hq2x_interp_32_diff(c[3], c[4]))
 421             mask |= 1 << 3;
 422         if (hq2x_interp_32_diff(c[5], c[4]))
 423             mask |= 1 << 4;
 424         if (hq2x_interp_32_diff(c[6], c[4]))
 425             mask |= 1 << 5;
 426         if (hq2x_interp_32_diff(c[7], c[4]))
 427             mask |= 1 << 6;
 428         if (hq2x_interp_32_diff(c[8], c[4]))
 429             mask |= 1 << 7;
 430
 431 #define P0 dst0[0]
 432 #define P1 dst0[1]
 433 #define P2 dst1[0]
 434 #define P3 dst1[1]
 435 #define HQ2X_MUR hq2x_interp_32_diff(c[1], c[5])
 436 #define HQ2X_MDR hq2x_interp_32_diff(c[5], c[7])
 437 #define HQ2X_MDL hq2x_interp_32_diff(c[7], c[3])
 438 #define HQ2X_MUL hq2x_interp_32_diff(c[3], c[1])
 439 #define IC(p0) c[p0]
 440 #define I11(p0,p1) hq2x_interp_32_11(c[p0], c[p1])
 441 #define I211(p0,p1,p2) hq2x_interp_32_211(c[p0], c[p1], c[p2])
 442 #define I31(p0,p1) hq2x_interp_32_31(c[p0], c[p1])
 443 #define I332(p0,p1,p2) hq2x_interp_32_332(c[p0], c[p1], c[p2])
 444 #define I431(p0,p1,p2) hq2x_interp_32_431(c[p0], c[p1], c[p2])
 445 #define I521(p0,p1,p2) hq2x_interp_32_521(c[p0], c[p1], c[p2])
 446 #define I53(p0,p1) hq2x_interp_32_53(c[p0], c[p1])
 447 #define I611(p0,p1,p2) hq2x_interp_32_611(c[p0], c[p1], c[p2])
 448 #define I71(p0,p1) hq2x_interp_32_71(c[p0], c[p1])
 449 #define I772(p0,p1,p2) hq2x_interp_32_772(c[p0], c[p1], c[p2])
 450 #define I97(p0,p1) hq2x_interp_32_97(c[p0], c[p1])
 451 #define I1411(p0,p1,p2) hq2x_interp_32_1411(c[p0], c[p1], c[p2])
 452 #define I151(p0,p1) hq2x_interp_32_151(c[p0], c[p1])
 453
 454         switch (mask) {
 455 #include "TextureFilters_hq2x.h"
 456         }
 457
 458 #undef P0
 459 #undef P1
 460 #undef P2
 461 #undef P3
 462 #undef HQ2X_MUR
 463 #undef HQ2X_MDR
 464 #undef HQ2X_MDL
 465 #undef HQ2X_MUL
 466 #undef IC
 467 #undef I11
 468 #undef I211
 469 #undef I31
 470 #undef I332
 471 #undef I431
 472 #undef I521
 473 #undef I53
 474 #undef I611
 475 #undef I71
 476 #undef I772
 477 #undef I97
 478 #undef I1411
 479 #undef I151
 480
 481         src0 += 1;
 482         src1 += 1;
 483         src2 += 1;
 484         dst0 += 2;
 485         dst1 += 2;
 486     }
 487 }
 488
 489 /***************************************************************************/
 490 /* LQ2x C implementation */
 491
 492 /*
 493 * This effect is derived from the hq2x effect made by Maxim Stepin
 494 */
 495
 496 static void lq2x_16_def(uint16* dst0, uint16* dst1, const uint16* src0, const uint16* src1, const uint16* src2, unsigned count)
 497 {
 498     unsigned i;
 499
 500     for(i=0;i<count;++i) {
 501         unsigned char mask;
 502
 503         uint16 c[9];
 504
 505         c[1] = src0[0];
 506         c[4] = src1[0];
 507         c[7] = src2[0];
 508
 509         if (i>0) {
 510             c[0] = src0[-1];
 511             c[3] = src1[-1];
 512             c[6] = src2[-1];
 513         } else {
 514             c[0] = c[1];
 515             c[3] = c[4];
 516             c[6] = c[7];
 517         }
 518
 519         if (i<count-1) {
 520             c[2] = src0[1];
 521             c[5] = src1[1];
 522             c[8] = src2[1];
 523         } else {
 524             c[2] = c[1];
 525             c[5] = c[4];
 526             c[8] = c[7];
 527         }
 528
 529         mask = 0;
 530
 531         if (c[0] != c[4])
 532             mask |= 1 << 0;
 533         if (c[1] != c[4])
 534             mask |= 1 << 1;
 535         if (c[2] != c[4])
 536             mask |= 1 << 2;
 537         if (c[3] != c[4])
 538             mask |= 1 << 3;
 539         if (c[5] != c[4])
 540             mask |= 1 << 4;
 541         if (c[6] != c[4])
 542             mask |= 1 << 5;
 543         if (c[7] != c[4])
 544             mask |= 1 << 6;
 545         if (c[8] != c[4])
 546             mask |= 1 << 7;
 547
 548 #define P0 dst0[0]
 549 #define P1 dst0[1]
 550 #define P2 dst1[0]
 551 #define P3 dst1[1]
 552 #define HQ2X_MUR (c[1] != c[5])
 553 #define HQ2X_MDR (c[5] != c[7])
 554 #define HQ2X_MDL (c[7] != c[3])
 555 #define HQ2X_MUL (c[3] != c[1])
 556 #define IC(p0) c[p0]
 557 #define I11(p0,p1) hq2x_interp_16_11(c[p0], c[p1])
 558 #define I211(p0,p1,p2) hq2x_interp_16_211(c[p0], c[p1], c[p2])
 559 #define I31(p0,p1) hq2x_interp_16_31(c[p0], c[p1])
 560 #define I332(p0,p1,p2) hq2x_interp_16_332(c[p0], c[p1], c[p2])
 561 #define I431(p0,p1,p2) hq2x_interp_16_431(c[p0], c[p1], c[p2])
 562 #define I521(p0,p1,p2) hq2x_interp_16_521(c[p0], c[p1], c[p2])
 563 #define I53(p0,p1) hq2x_interp_16_53(c[p0], c[p1])
 564 #define I611(p0,p1,p2) hq2x_interp_16_611(c[p0], c[p1], c[p2])
 565 #define I71(p0,p1) hq2x_interp_16_71(c[p0], c[p1])
 566 #define I772(p0,p1,p2) hq2x_interp_16_772(c[p0], c[p1], c[p2])
 567 #define I97(p0,p1) hq2x_interp_16_97(c[p0], c[p1])
 568 #define I1411(p0,p1,p2) hq2x_interp_16_1411(c[p0], c[p1], c[p2])
 569 #define I151(p0,p1) hq2x_interp_16_151(c[p0], c[p1])
 570
 571         switch (mask) {
 572 #include "TextureFilters_lq2x.h"
 573         }
 574
 575 #undef P0
 576 #undef P1
 577 #undef P2
 578 #undef P3
 579 #undef HQ2X_MUR
 580 #undef HQ2X_MDR
 581 #undef HQ2X_MDL
 582 #undef HQ2X_MUL
 583 #undef IC
 584 #undef I11
 585 #undef I211
 586 #undef I31
 587 #undef I332
 588 #undef I431
 589 #undef I521
 590 #undef I53
 591 #undef I611
 592 #undef I71
 593 #undef I772
 594 #undef I97
 595 #undef I1411
 596 #undef I151
 597
 598         src0 += 1;
 599         src1 += 1;
 600         src2 += 1;
 601         dst0 += 2;
 602         dst1 += 2;
 603     }
 604 }
 605
 606 static void lq2x_32_def(uint32* dst0, uint32* dst1, const uint32* src0, const uint32* src1, const uint32* src2, unsigned count)
 607 {
 608     unsigned i;
 609
 610     for(i=0;i<count;++i) {
 611         unsigned char mask;
 612
 613         uint32 c[9];
 614
 615         c[1] = src0[0];
 616         c[4] = src1[0];
 617         c[7] = src2[0];
 618
 619         if (i>0) {
 620             c[0] = src0[-1];
 621             c[3] = src1[-1];
 622             c[6] = src2[-1];
 623         } else {
 624             c[0] = c[1];
 625             c[3] = c[4];
 626             c[6] = c[7];
 627         }
 628
 629         if (i<count-1) {
 630             c[2] = src0[1];
 631             c[5] = src1[1];
 632             c[8] = src2[1];
 633         } else {
 634             c[2] = c[1];
 635             c[5] = c[4];
 636             c[8] = c[7];
 637         }
 638
 639         mask = 0;
 640
 641         if (c[0] != c[4])
 642             mask |= 1 << 0;
 643         if (c[1] != c[4])
 644             mask |= 1 << 1;
 645         if (c[2] != c[4])
 646             mask |= 1 << 2;
 647         if (c[3] != c[4])
 648             mask |= 1 << 3;
 649         if (c[5] != c[4])
 650             mask |= 1 << 4;
 651         if (c[6] != c[4])
 652             mask |= 1 << 5;
 653         if (c[7] != c[4])
 654             mask |= 1 << 6;
 655         if (c[8] != c[4])
 656             mask |= 1 << 7;
 657
 658 #define P0 dst0[0]
 659 #define P1 dst0[1]
 660 #define P2 dst1[0]
 661 #define P3 dst1[1]
 662 #define HQ2X_MUR (c[1] != c[5])
 663 #define HQ2X_MDR (c[5] != c[7])
 664 #define HQ2X_MDL (c[7] != c[3])
 665 #define HQ2X_MUL (c[3] != c[1])
 666 #define IC(p0) c[p0]
 667 #define I11(p0,p1) hq2x_interp_32_11(c[p0], c[p1])
 668 #define I211(p0,p1,p2) hq2x_interp_32_211(c[p0], c[p1], c[p2])
 669 #define I31(p0,p1) hq2x_interp_32_31(c[p0], c[p1])
 670 #define I332(p0,p1,p2) hq2x_interp_32_332(c[p0], c[p1], c[p2])
 671 #define I431(p0,p1,p2) hq2x_interp_32_431(c[p0], c[p1], c[p2])
 672 #define I521(p0,p1,p2) hq2x_interp_32_521(c[p0], c[p1], c[p2])
 673 #define I53(p0,p1) hq2x_interp_32_53(c[p0], c[p1])
 674 #define I611(p0,p1,p2) hq2x_interp_32_611(c[p0], c[p1], c[p2])
 675 #define I71(p0,p1) hq2x_interp_32_71(c[p0], c[p1])
 676 #define I772(p0,p1,p2) hq2x_interp_32_772(c[p0], c[p1], c[p2])
 677 #define I97(p0,p1) hq2x_interp_32_97(c[p0], c[p1])
 678 #define I1411(p0,p1,p2) hq2x_interp_32_1411(c[p0], c[p1], c[p2])
 679 #define I151(p0,p1) hq2x_interp_32_151(c[p0], c[p1])
 680
 681         switch (mask) {
 682 #include "TextureFilters_lq2x.h"
 683         }
 684
 685 #undef P0
 686 #undef P1
 687 #undef P2
 688 #undef P3
 689 #undef HQ2X_MUR
 690 #undef HQ2X_MDR
 691 #undef HQ2X_MDL
 692 #undef HQ2X_MUL
 693 #undef IC
 694 #undef I11
 695 #undef I211
 696 #undef I31
 697 #undef I332
 698 #undef I431
 699 #undef I521
 700 #undef I53
 701 #undef I611
 702 #undef I71
 703 #undef I772
 704 #undef I97
 705 #undef I1411
 706 #undef I151
 707
 708         src0 += 1;
 709         src1 += 1;
 710         src2 += 1;
 711         dst0 += 2;
 712         dst1 += 2;
 713     }
 714 }
 715
 716 void hq2x_16(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height)
 717 {
 718     uint16 *dst0 = (uint16 *)dstPtr;
 719     uint16 *dst1 = dst0 + (dstPitch >> 1);
 720
 721     uint16 *src0 = (uint16 *)srcPtr;
 722     uint16 *src1 = src0 + (srcPitch >> 1);
 723     uint16 *src2 = src1 + (srcPitch >> 1);
 724
 725     hq2x_16_def(dst0, dst1, src0, src0, src1, width);
 726     if( height == 1 ) return;
 727
 728     int count = height;
 729
 730     count -= 2;
 731     while(count>0) {
 732         dst0 += dstPitch;
 733         dst1 += dstPitch;
 734         hq2x_16_def(dst0, dst1, src0, src1, src2, width);
 735         src0 = src1;
 736         src1 = src2;
 737         src2 += srcPitch >> 1;
 738         --count;
 739     }
 740     dst0 += dstPitch;
 741     dst1 += dstPitch;
 742     hq2x_16_def(dst0, dst1, src0, src1, src1, width);
 743 }
 744
 745 void hq2x_32(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height)
 746 {
 747     uint32 *dst0 = (uint32 *)dstPtr;
 748     uint32 *dst1 = dst0 + (dstPitch >> 2);
 749
 750     uint32 *src0 = (uint32 *)srcPtr;
 751     uint32 *src1 = src0 + (srcPitch >> 2);
 752     uint32 *src2 = src1 + (srcPitch >> 2);
 753     hq2x_32_def(dst0, dst1, src0, src0, src1, width);
 754     if( height == 1 ) return;
 755
 756     int count = height;
 757
 758     count -= 2;
 759     while(count>0) {
 760         dst0 += dstPitch >> 1;
 761         dst1 += dstPitch >> 1;
 762         hq2x_32_def(dst0, dst1, src0, src1, src2, width);
 763         src0 = src1;
 764         src1 = src2;
 765         src2 += srcPitch >> 2;
 766         --count;
 767     }
 768     dst0 += dstPitch >> 1;
 769     dst1 += dstPitch >> 1;
 770     hq2x_32_def(dst0, dst1, src0, src1, src1, width);
 771 }
 772
 773 void lq2x_16(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height)
 774 {
 775     uint16 *dst0 = (uint16 *)dstPtr;
 776     uint16 *dst1 = dst0 + (dstPitch >> 1);
 777
 778     uint16 *src0 = (uint16 *)srcPtr;
 779     uint16 *src1 = src0 + (srcPitch >> 1);
 780     uint16 *src2 = src1 + (srcPitch >> 1);
 781
 782     lq2x_16_def(dst0, dst1, src0, src0, src1, width);
 783     if( height == 1 ) return;
 784
 785     int count = height;
 786
 787     count -= 2;
 788     while(count>0) {
 789         dst0 += dstPitch;
 790         dst1 += dstPitch;
 791         hq2x_16_def(dst0, dst1, src0, src1, src2, width);
 792         src0 = src1;
 793         src1 = src2;
 794         src2 += srcPitch >> 1;
 795         --count;
 796     }
 797     dst0 += dstPitch;
 798     dst1 += dstPitch;
 799     lq2x_16_def(dst0, dst1, src0, src1, src1, width);
 800 }
 801
 802 void lq2x_32(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height)
 803 {
 804     uint32 *dst0 = (uint32 *)dstPtr;
 805     uint32 *dst1 = dst0 + (dstPitch >> 2);
 806
 807     uint32 *src0 = (uint32 *)srcPtr;
 808     uint32 *src1 = src0 + (srcPitch >> 2);
 809     uint32 *src2 = src1 + (srcPitch >> 2);
 810     lq2x_32_def(dst0, dst1, src0, src0, src1, width);
 811     if( height == 1 ) return;
 812
 813     int count = height;
 814
 815     count -= 2;
 816     while(count>0) {
 817         dst0 += dstPitch >> 1;
 818         dst1 += dstPitch >> 1;
 819         hq2x_32_def(dst0, dst1, src0, src1, src2, width);
 820         src0 = src1;
 821         src1 = src2;
 822         src2 += srcPitch >> 2;
 823         --count;
 824     }
 825     dst0 += dstPitch >> 1;
 826     dst1 += dstPitch >> 1;
 827     lq2x_32_def(dst0, dst1, src0, src1, src1, width);
 828 }
 829
 830 void hq2x_init(unsigned bits_per_pixel)
 831 {
 832     interp_set(bits_per_pixel);
 833 }
 834
 835 /************************************************************************/
 836 /* hq3x filters                                                         */
 837 /************************************************************************/
 838
 839 /************************************************************************/
 840 /* scale2x filters                                                      */
 841 /************************************************************************/
 842
 843 /************************************************************************/
 844 /* scale3x filters                                                      */
 845 /************************************************************************/
 846