libmpcodecs/vf_2xsai.c

   1 /*
   2  * This file is part of MPlayer.
   3  *
   4  * MPlayer is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * MPlayer is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along
  15  * with MPlayer; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  17  */
  18
  19 #include <stdio.h>
  20 #include <stdlib.h>
  21 #include <string.h>
  22 #include <inttypes.h>
  23
  24 #include "config.h"
  25 #include "mp_msg.h"
  26
  27 #include "img_format.h"
  28 #include "mp_image.h"
  29 #include "vf.h"
  30
  31 //===========================================================================//
  32
  33 /* FIXME: these all belong in the context, not as globals! */
  34
  35 static uint32_t colorMask = 0xF7DEF7DE;
  36 static uint32_t lowPixelMask = 0x08210821;
  37 static uint32_t qcolorMask = 0xE79CE79C;
  38 static uint32_t qlowpixelMask = 0x18631863;
  39 static uint32_t redblueMask = 0xF81F;
  40 static uint32_t greenMask = 0x7E0;
  41 static int PixelsPerMask = 2;
  42
  43 #define makecol(r,g,b) (r+(g<<8)+(b<<16))
  44 #define makecol_depth(d,r,g,b) (r+(g<<8)+(b<<16))
  45
  46 static int Init_2xSaI(int d)
  47 {
  48
  49         int minr = 0, ming = 0, minb = 0;
  50         int i;
  51
  52 //      if (d != 15 && d != 16 && d != 24 && d != 32)
  53 //              return -1;
  54
  55         /* Get lowest color bit */
  56         for (i = 0; i < 255; i++) {
  57                 if (!minr)
  58                         minr = makecol(i, 0, 0);
  59                 if (!ming)
  60                         ming = makecol(0, i, 0);
  61                 if (!minb)
  62                         minb = makecol(0, 0, i);
  63         }
  64
  65         colorMask = (makecol_depth(d, 255, 0, 0) - minr) | (makecol_depth(d, 0, 255, 0) - ming) | (makecol_depth(d, 0, 0, 255) - minb);
  66         lowPixelMask = minr | ming | minb;
  67         qcolorMask = (makecol_depth(d, 255, 0, 0) - 3 * minr) | (makecol_depth(d, 0, 255, 0) - 3 * ming) | (makecol_depth(d, 0, 0, 255) - 3 * minb);
  68         qlowpixelMask = (minr * 3) | (ming * 3) | (minb * 3);
  69         redblueMask = makecol_depth(d, 255, 0, 255);
  70         greenMask = makecol_depth(d, 0, 255, 0);
  71
  72         PixelsPerMask = (d <= 16) ? 2 : 1;
  73
  74         if (PixelsPerMask == 2) {
  75                 colorMask |= (colorMask << 16);
  76                 qcolorMask |= (qcolorMask << 16);
  77                 lowPixelMask |= (lowPixelMask << 16);
  78                 qlowpixelMask |= (qlowpixelMask << 16);
  79         }
  80
  81 //      TRACE("Color Mask:       0x%lX\n", colorMask);
  82 //      TRACE("Low Pixel Mask:   0x%lX\n", lowPixelMask);
  83 //      TRACE("QColor Mask:      0x%lX\n", qcolorMask);
  84 //      TRACE("QLow Pixel Mask:  0x%lX\n", qlowpixelMask);
  85
  86         return 0;
  87 }
  88
  89
  90 #define GET_RESULT(A, B, C, D) ((A != C || A != D) - (B != C || B != D))
  91
  92 #define INTERPOLATE(A, B) (((A & colorMask) >> 1) + ((B & colorMask) >> 1) + (A & B & lowPixelMask))
  93
  94 #define Q_INTERPOLATE(A, B, C, D) ((A & qcolorMask) >> 2) + ((B & qcolorMask) >> 2) + ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2) \
  95         + ((((A & qlowpixelMask) + (B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask)) >> 2) & qlowpixelMask)
  96
  97
  98 static void Super2xSaI_ex(uint8_t *src, uint32_t src_pitch,
  99                           uint8_t *dst, uint32_t dst_pitch,
 100                           uint32_t width, uint32_t height, int sbpp)
 101 {
 102
 103         unsigned int x, y;
 104         uint32_t color[16];
 105         unsigned char *src_line[4];
 106
 107         /* Point to the first 3 lines. */
 108         src_line[0] = src;
 109         src_line[1] = src;
 110         src_line[2] = src + src_pitch;
 111         src_line[3] = src + src_pitch * 2;
 112
 113         x = 0, y = 0;
 114
 115         if (PixelsPerMask == 2) {
 116                 unsigned short *sbp;
 117                 sbp = (unsigned short*)src_line[0];
 118                 color[0] = *sbp;       color[1] = color[0];   color[2] = color[0];    color[3] = color[0];
 119                 color[4] = color[0];   color[5] = color[0];   color[6] = *(sbp + 1);  color[7] = *(sbp + 2);
 120                 sbp = (unsigned short*)src_line[2];
 121                 color[8] = *sbp;     color[9] = color[8];     color[10] = *(sbp + 1); color[11] = *(sbp + 2);
 122                 sbp = (unsigned short*)src_line[3];
 123                 color[12] = *sbp;    color[13] = color[12];   color[14] = *(sbp + 1); color[15] = *(sbp + 2);
 124         }
 125         else {
 126                 uint32_t *lbp;
 127                 lbp = (uint32_t*)src_line[0];
 128                 color[0] = *lbp;       color[1] = color[0];   color[2] = color[0];    color[3] = color[0];
 129                 color[4] = color[0];   color[5] = color[0];   color[6] = *(lbp + 1);  color[7] = *(lbp + 2);
 130                 lbp = (uint32_t*)src_line[2];
 131                 color[8] = *lbp;     color[9] = color[8];     color[10] = *(lbp + 1); color[11] = *(lbp + 2);
 132                 lbp = (uint32_t*)src_line[3];
 133                 color[12] = *lbp;    color[13] = color[12];   color[14] = *(lbp + 1); color[15] = *(lbp + 2);
 134         }
 135
 136         for (y = 0; y < height; y++) {
 137                 unsigned char *dst_line[2];
 138
 139                 dst_line[0] = dst + dst_pitch*2*y;
 140                 dst_line[1] = dst + dst_pitch*(2*y+1);
 141
 142                 /* Todo: x = width - 2, x = width - 1 */
 143
 144                 for (x = 0; x < width; x++) {
 145                         uint32_t product1a, product1b, product2a, product2b;
 146
 147 //---------------------------------------  B0 B1 B2 B3    0  1  2  3
 148 //                                         4  5* 6  S2 -> 4  5* 6  7
 149 //                                         1  2  3  S1    8  9 10 11
 150 //                                         A0 A1 A2 A3   12 13 14 15
 151 //--------------------------------------
 152                         if (color[9] == color[6] && color[5] != color[10]) {
 153                                 product2b = color[9];
 154                                 product1b = product2b;
 155                         }
 156                         else if (color[5] == color[10] && color[9] != color[6]) {
 157                                 product2b = color[5];
 158                                 product1b = product2b;
 159                         }
 160                         else if (color[5] == color[10] && color[9] == color[6]) {
 161                                 int r = 0;
 162
 163                                 r += GET_RESULT(color[6], color[5], color[8], color[13]);
 164                                 r += GET_RESULT(color[6], color[5], color[4], color[1]);
 165                                 r += GET_RESULT(color[6], color[5], color[14], color[11]);
 166                                 r += GET_RESULT(color[6], color[5], color[2], color[7]);
 167
 168                                 if (r > 0)
 169                                         product1b = color[6];
 170                                 else if (r < 0)
 171                                         product1b = color[5];
 172                                 else
 173                                         product1b = INTERPOLATE(color[5], color[6]);
 174
 175                                 product2b = product1b;
 176
 177                         }
 178                         else {
 179                                 if (color[6] == color[10] && color[10] == color[13] && color[9] != color[14] && color[10] != color[12])
 180                                         product2b = Q_INTERPOLATE(color[10], color[10], color[10], color[9]);
 181                                 else if (color[5] == color[9] && color[9] == color[14] && color[13] != color[10] && color[9] != color[15])
 182                                         product2b = Q_INTERPOLATE(color[9], color[9], color[9], color[10]);
 183                                 else
 184                                         product2b = INTERPOLATE(color[9], color[10]);
 185
 186                                 if (color[6] == color[10] && color[6] == color[1] && color[5] != color[2] && color[6] != color[0])
 187                                         product1b = Q_INTERPOLATE(color[6], color[6], color[6], color[5]);
 188                                 else if (color[5] == color[9] && color[5] == color[2] && color[1] != color[6] && color[5] != color[3])
 189                                         product1b = Q_INTERPOLATE(color[6], color[5], color[5], color[5]);
 190                                 else
 191                                         product1b = INTERPOLATE(color[5], color[6]);
 192                         }
 193
 194                         if (color[5] == color[10] && color[9] != color[6] && color[4] == color[5] && color[5] != color[14])
 195                                 product2a = INTERPOLATE(color[9], color[5]);
 196                         else if (color[5] == color[8] && color[6] == color[5] && color[4] != color[9] && color[5] != color[12])
 197                                 product2a = INTERPOLATE(color[9], color[5]);
 198                         else
 199                                 product2a = color[9];
 200
 201                         if (color[9] == color[6] && color[5] != color[10] && color[8] == color[9] && color[9] != color[2])
 202                                 product1a = INTERPOLATE(color[9], color[5]);
 203                         else if (color[4] == color[9] && color[10] == color[9] && color[8] != color[5] && color[9] != color[0])
 204                                 product1a = INTERPOLATE(color[9], color[5]);
 205                         else
 206                                 product1a = color[5];
 207
 208                         if (PixelsPerMask == 2) {
 209                                 *((uint32_t *) (&dst_line[0][x * 4])) = product1a | (product1b << 16);
 210                                 *((uint32_t *) (&dst_line[1][x * 4])) = product2a | (product2b << 16);
 211                         }
 212                         else {
 213                                 *((uint32_t *) (&dst_line[0][x * 8])) = product1a;
 214                                 *((uint32_t *) (&dst_line[0][x * 8 + 4])) = product1b;
 215                                 *((uint32_t *) (&dst_line[1][x * 8])) = product2a;
 216                                 *((uint32_t *) (&dst_line[1][x * 8 + 4])) = product2b;
 217                         }
 218
 219                         /* Move color matrix forward */
 220                         color[0] = color[1]; color[4] = color[5]; color[8] = color[9];   color[12] = color[13];
 221                         color[1] = color[2]; color[5] = color[6]; color[9] = color[10];  color[13] = color[14];
 222                         color[2] = color[3]; color[6] = color[7]; color[10] = color[11]; color[14] = color[15];
 223
 224                         if (x < width - 3) {
 225                                 x += 3;
 226                                 if (PixelsPerMask == 2) {
 227                                         color[3] = *(((unsigned short*)src_line[0]) + x);
 228                                         color[7] = *(((unsigned short*)src_line[1]) + x);
 229                                         color[11] = *(((unsigned short*)src_line[2]) + x);
 230                                         color[15] = *(((unsigned short*)src_line[3]) + x);
 231                                 }
 232                                 else {
 233                                         color[3] = *(((uint32_t*)src_line[0]) + x);
 234                                         color[7] = *(((uint32_t*)src_line[1]) + x);
 235                                         color[11] = *(((uint32_t*)src_line[2]) + x);
 236                                         color[15] = *(((uint32_t*)src_line[3]) + x);
 237                                 }
 238                                 x -= 3;
 239                         }
 240                 }
 241
 242                 /* We're done with one line, so we shift the source lines up */
 243                 src_line[0] = src_line[1];
 244                 src_line[1] = src_line[2];
 245                 src_line[2] = src_line[3];
 246
 247                 /* Read next line */
 248                 if (y + 3 >= height)
 249                         src_line[3] = src_line[2];
 250                 else
 251                         src_line[3] = src_line[2] + src_pitch;
 252
 253                 /* Then shift the color matrix up */
 254                 if (PixelsPerMask == 2) {
 255                         unsigned short *sbp;
 256                         sbp = (unsigned short*)src_line[0];
 257                         color[0] = *sbp;     color[1] = color[0];    color[2] = *(sbp + 1);  color[3] = *(sbp + 2);
 258                         sbp = (unsigned short*)src_line[1];
 259                         color[4] = *sbp;     color[5] = color[4];    color[6] = *(sbp + 1);  color[7] = *(sbp + 2);
 260                         sbp = (unsigned short*)src_line[2];
 261                         color[8] = *sbp;     color[9] = color[9];    color[10] = *(sbp + 1); color[11] = *(sbp + 2);
 262                         sbp = (unsigned short*)src_line[3];
 263                         color[12] = *sbp;    color[13] = color[12];  color[14] = *(sbp + 1); color[15] = *(sbp + 2);
 264                 }
 265                 else {
 266                         uint32_t *lbp;
 267                         lbp = (uint32_t*)src_line[0];
 268                         color[0] = *lbp;     color[1] = color[0];    color[2] = *(lbp + 1);  color[3] = *(lbp + 2);
 269                         lbp = (uint32_t*)src_line[1];
 270                         color[4] = *lbp;     color[5] = color[4];    color[6] = *(lbp + 1);  color[7] = *(lbp + 2);
 271                         lbp = (uint32_t*)src_line[2];
 272                         color[8] = *lbp;     color[9] = color[9];    color[10] = *(lbp + 1); color[11] = *(lbp + 2);
 273                         lbp = (uint32_t*)src_line[3];
 274                         color[12] = *lbp;    color[13] = color[12];  color[14] = *(lbp + 1); color[15] = *(lbp + 2);
 275                 }
 276
 277         } // y loop
 278
 279 }
 280
 281
 282 //===========================================================================//
 283
 284 static int config(struct vf_instance *vf,
 285         int width, int height, int d_width, int d_height,
 286         unsigned int flags, unsigned int outfmt){
 287
 288     Init_2xSaI(outfmt&255);
 289
 290     return vf_next_config(vf,2*width,2*height,2*d_width,2*d_height,flags,outfmt);
 291 }
 292
 293 static int put_image(struct vf_instance *vf, mp_image_t *mpi, double pts){
 294     mp_image_t *dmpi;
 295
 296     // hope we'll get DR buffer:
 297     dmpi=vf_get_image(vf->next,mpi->imgfmt,
 298         MP_IMGTYPE_TEMP, MP_IMGFLAG_ACCEPT_STRIDE,
 299         2*mpi->w, 2*mpi->h);
 300
 301     Super2xSaI_ex(mpi->planes[0], mpi->stride[0],
 302                   dmpi->planes[0], dmpi->stride[0],
 303                   mpi->w, mpi->h, mpi->bpp/8);
 304
 305     return vf_next_put_image(vf,dmpi, pts);
 306 }
 307
 308 //===========================================================================//
 309
 310 static int query_format(struct vf_instance *vf, unsigned int fmt){
 311     switch(fmt){
 312 //    case IMGFMT_BGR15:
 313 //    case IMGFMT_BGR16:
 314     case IMGFMT_BGR32:
 315         return vf_next_query_format(vf,fmt);
 316     }
 317     return 0;
 318 }
 319
 320 static int vf_open(vf_instance_t *vf, char *args){
 321     vf->config=config;
 322     vf->put_image=put_image;
 323     vf->query_format=query_format;
 324     return 1;
 325 }
 326
 327 const vf_info_t vf_info_2xsai = {
 328     "2xSai BGR bitmap 2x scaler",
 329     "2xsai",
 330     "A'rpi",
 331     "http://elektron.its.tudelft.nl/~dalikifa/",
 332     vf_open,
 333     NULL
 334 };
 335
 336 //===========================================================================//