| /* |
| * This file is part of MPlayer. |
| * |
| * MPlayer is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * MPlayer is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License along |
| * with MPlayer; if not, write to the Free Software Foundation, Inc., |
| * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| */ |
| |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <inttypes.h> |
| |
| #include "config.h" |
| #include "mp_msg.h" |
| |
| #include "img_format.h" |
| #include "mp_image.h" |
| #include "vf.h" |
| |
| //===========================================================================// |
| |
| /* FIXME: these all belong in the context, not as globals! */ |
| |
| static uint32_t colorMask = 0xF7DEF7DE; |
| static uint32_t lowPixelMask = 0x08210821; |
| static uint32_t qcolorMask = 0xE79CE79C; |
| static uint32_t qlowpixelMask = 0x18631863; |
| static uint32_t redblueMask = 0xF81F; |
| static uint32_t greenMask = 0x7E0; |
| static int PixelsPerMask = 2; |
| |
| #define makecol(r,g,b) (r+(g<<8)+(b<<16)) |
| #define makecol_depth(d,r,g,b) (r+(g<<8)+(b<<16)) |
| |
| static int Init_2xSaI(int d) |
| { |
| |
| int minr = 0, ming = 0, minb = 0; |
| int i; |
| |
| // if (d != 15 && d != 16 && d != 24 && d != 32) |
| // return -1; |
| |
| /* Get lowest color bit */ |
| for (i = 0; i < 255; i++) { |
| if (!minr) |
| minr = makecol(i, 0, 0); |
| if (!ming) |
| ming = makecol(0, i, 0); |
| if (!minb) |
| minb = makecol(0, 0, i); |
| } |
| |
| colorMask = (makecol_depth(d, 255, 0, 0) - minr) | (makecol_depth(d, 0, 255, 0) - ming) | (makecol_depth(d, 0, 0, 255) - minb); |
| lowPixelMask = minr | ming | minb; |
| 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); |
| qlowpixelMask = (minr * 3) | (ming * 3) | (minb * 3); |
| redblueMask = makecol_depth(d, 255, 0, 255); |
| greenMask = makecol_depth(d, 0, 255, 0); |
| |
| PixelsPerMask = (d <= 16) ? 2 : 1; |
| |
| if (PixelsPerMask == 2) { |
| colorMask |= (colorMask << 16); |
| qcolorMask |= (qcolorMask << 16); |
| lowPixelMask |= (lowPixelMask << 16); |
| qlowpixelMask |= (qlowpixelMask << 16); |
| } |
| |
| // TRACE("Color Mask: 0x%lX\n", colorMask); |
| // TRACE("Low Pixel Mask: 0x%lX\n", lowPixelMask); |
| // TRACE("QColor Mask: 0x%lX\n", qcolorMask); |
| // TRACE("QLow Pixel Mask: 0x%lX\n", qlowpixelMask); |
| |
| return 0; |
| } |
| |
| |
| #define GET_RESULT(A, B, C, D) ((A != C || A != D) - (B != C || B != D)) |
| |
| #define INTERPOLATE(A, B) (((A & colorMask) >> 1) + ((B & colorMask) >> 1) + (A & B & lowPixelMask)) |
| |
| #define Q_INTERPOLATE(A, B, C, D) ((A & qcolorMask) >> 2) + ((B & qcolorMask) >> 2) + ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2) \ |
| + ((((A & qlowpixelMask) + (B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask)) >> 2) & qlowpixelMask) |
| |
| |
| static void Super2xSaI_ex(uint8_t *src, uint32_t src_pitch, |
| uint8_t *dst, uint32_t dst_pitch, |
| uint32_t width, uint32_t height, int sbpp) |
| { |
| |
| unsigned int x, y; |
| uint32_t color[16]; |
| unsigned char *src_line[4]; |
| |
| /* Point to the first 3 lines. */ |
| src_line[0] = src; |
| src_line[1] = src; |
| src_line[2] = src + src_pitch; |
| src_line[3] = src + src_pitch * 2; |
| |
| x = 0, y = 0; |
| |
| if (PixelsPerMask == 2) { |
| unsigned short *sbp; |
| sbp = (unsigned short*)src_line[0]; |
| color[0] = *sbp; color[1] = color[0]; color[2] = color[0]; color[3] = color[0]; |
| color[4] = color[0]; color[5] = color[0]; color[6] = *(sbp + 1); color[7] = *(sbp + 2); |
| sbp = (unsigned short*)src_line[2]; |
| color[8] = *sbp; color[9] = color[8]; color[10] = *(sbp + 1); color[11] = *(sbp + 2); |
| sbp = (unsigned short*)src_line[3]; |
| color[12] = *sbp; color[13] = color[12]; color[14] = *(sbp + 1); color[15] = *(sbp + 2); |
| } |
| else { |
| uint32_t *lbp; |
| lbp = (uint32_t*)src_line[0]; |
| color[0] = *lbp; color[1] = color[0]; color[2] = color[0]; color[3] = color[0]; |
| color[4] = color[0]; color[5] = color[0]; color[6] = *(lbp + 1); color[7] = *(lbp + 2); |
| lbp = (uint32_t*)src_line[2]; |
| color[8] = *lbp; color[9] = color[8]; color[10] = *(lbp + 1); color[11] = *(lbp + 2); |
| lbp = (uint32_t*)src_line[3]; |
| color[12] = *lbp; color[13] = color[12]; color[14] = *(lbp + 1); color[15] = *(lbp + 2); |
| } |
| |
| for (y = 0; y < height; y++) { |
| unsigned char *dst_line[2]; |
| |
| dst_line[0] = dst + dst_pitch*2*y; |
| dst_line[1] = dst + dst_pitch*(2*y+1); |
| |
| /* Todo: x = width - 2, x = width - 1 */ |
| |
| for (x = 0; x < width; x++) { |
| uint32_t product1a, product1b, product2a, product2b; |
| |
| //--------------------------------------- B0 B1 B2 B3 0 1 2 3 |
| // 4 5* 6 S2 -> 4 5* 6 7 |
| // 1 2 3 S1 8 9 10 11 |
| // A0 A1 A2 A3 12 13 14 15 |
| //-------------------------------------- |
| if (color[9] == color[6] && color[5] != color[10]) { |
| product2b = color[9]; |
| product1b = product2b; |
| } |
| else if (color[5] == color[10] && color[9] != color[6]) { |
| product2b = color[5]; |
| product1b = product2b; |
| } |
| else if (color[5] == color[10] && color[9] == color[6]) { |
| int r = 0; |
| |
| r += GET_RESULT(color[6], color[5], color[8], color[13]); |
| r += GET_RESULT(color[6], color[5], color[4], color[1]); |
| r += GET_RESULT(color[6], color[5], color[14], color[11]); |
| r += GET_RESULT(color[6], color[5], color[2], color[7]); |
| |
| if (r > 0) |
| product1b = color[6]; |
| else if (r < 0) |
| product1b = color[5]; |
| else |
| product1b = INTERPOLATE(color[5], color[6]); |
| |
| product2b = product1b; |
| |
| } |
| else { |
| if (color[6] == color[10] && color[10] == color[13] && color[9] != color[14] && color[10] != color[12]) |
| product2b = Q_INTERPOLATE(color[10], color[10], color[10], color[9]); |
| else if (color[5] == color[9] && color[9] == color[14] && color[13] != color[10] && color[9] != color[15]) |
| product2b = Q_INTERPOLATE(color[9], color[9], color[9], color[10]); |
| else |
| product2b = INTERPOLATE(color[9], color[10]); |
| |
| if (color[6] == color[10] && color[6] == color[1] && color[5] != color[2] && color[6] != color[0]) |
| product1b = Q_INTERPOLATE(color[6], color[6], color[6], color[5]); |
| else if (color[5] == color[9] && color[5] == color[2] && color[1] != color[6] && color[5] != color[3]) |
| product1b = Q_INTERPOLATE(color[6], color[5], color[5], color[5]); |
| else |
| product1b = INTERPOLATE(color[5], color[6]); |
| } |
| |
| if (color[5] == color[10] && color[9] != color[6] && color[4] == color[5] && color[5] != color[14]) |
| product2a = INTERPOLATE(color[9], color[5]); |
| else if (color[5] == color[8] && color[6] == color[5] && color[4] != color[9] && color[5] != color[12]) |
| product2a = INTERPOLATE(color[9], color[5]); |
| else |
| product2a = color[9]; |
| |
| if (color[9] == color[6] && color[5] != color[10] && color[8] == color[9] && color[9] != color[2]) |
| product1a = INTERPOLATE(color[9], color[5]); |
| else if (color[4] == color[9] && color[10] == color[9] && color[8] != color[5] && color[9] != color[0]) |
| product1a = INTERPOLATE(color[9], color[5]); |
| else |
| product1a = color[5]; |
| |
| if (PixelsPerMask == 2) { |
| *((uint32_t *) (&dst_line[0][x * 4])) = product1a | (product1b << 16); |
| *((uint32_t *) (&dst_line[1][x * 4])) = product2a | (product2b << 16); |
| } |
| else { |
| *((uint32_t *) (&dst_line[0][x * 8])) = product1a; |
| *((uint32_t *) (&dst_line[0][x * 8 + 4])) = product1b; |
| *((uint32_t *) (&dst_line[1][x * 8])) = product2a; |
| *((uint32_t *) (&dst_line[1][x * 8 + 4])) = product2b; |
| } |
| |
| /* Move color matrix forward */ |
| color[0] = color[1]; color[4] = color[5]; color[8] = color[9]; color[12] = color[13]; |
| color[1] = color[2]; color[5] = color[6]; color[9] = color[10]; color[13] = color[14]; |
| color[2] = color[3]; color[6] = color[7]; color[10] = color[11]; color[14] = color[15]; |
| |
| if (x < width - 3) { |
| x += 3; |
| if (PixelsPerMask == 2) { |
| color[3] = *(((unsigned short*)src_line[0]) + x); |
| color[7] = *(((unsigned short*)src_line[1]) + x); |
| color[11] = *(((unsigned short*)src_line[2]) + x); |
| color[15] = *(((unsigned short*)src_line[3]) + x); |
| } |
| else { |
| color[3] = *(((uint32_t*)src_line[0]) + x); |
| color[7] = *(((uint32_t*)src_line[1]) + x); |
| color[11] = *(((uint32_t*)src_line[2]) + x); |
| color[15] = *(((uint32_t*)src_line[3]) + x); |
| } |
| x -= 3; |
| } |
| } |
| |
| /* We're done with one line, so we shift the source lines up */ |
| src_line[0] = src_line[1]; |
| src_line[1] = src_line[2]; |
| src_line[2] = src_line[3]; |
| |
| /* Read next line */ |
| if (y + 3 >= height) |
| src_line[3] = src_line[2]; |
| else |
| src_line[3] = src_line[2] + src_pitch; |
| |
| /* Then shift the color matrix up */ |
| if (PixelsPerMask == 2) { |
| unsigned short *sbp; |
| sbp = (unsigned short*)src_line[0]; |
| color[0] = *sbp; color[1] = color[0]; color[2] = *(sbp + 1); color[3] = *(sbp + 2); |
| sbp = (unsigned short*)src_line[1]; |
| color[4] = *sbp; color[5] = color[4]; color[6] = *(sbp + 1); color[7] = *(sbp + 2); |
| sbp = (unsigned short*)src_line[2]; |
| color[8] = *sbp; color[9] = color[9]; color[10] = *(sbp + 1); color[11] = *(sbp + 2); |
| sbp = (unsigned short*)src_line[3]; |
| color[12] = *sbp; color[13] = color[12]; color[14] = *(sbp + 1); color[15] = *(sbp + 2); |
| } |
| else { |
| uint32_t *lbp; |
| lbp = (uint32_t*)src_line[0]; |
| color[0] = *lbp; color[1] = color[0]; color[2] = *(lbp + 1); color[3] = *(lbp + 2); |
| lbp = (uint32_t*)src_line[1]; |
| color[4] = *lbp; color[5] = color[4]; color[6] = *(lbp + 1); color[7] = *(lbp + 2); |
| lbp = (uint32_t*)src_line[2]; |
| color[8] = *lbp; color[9] = color[9]; color[10] = *(lbp + 1); color[11] = *(lbp + 2); |
| lbp = (uint32_t*)src_line[3]; |
| color[12] = *lbp; color[13] = color[12]; color[14] = *(lbp + 1); color[15] = *(lbp + 2); |
| } |
| |
| } // y loop |
| |
| } |
| |
| |
| //===========================================================================// |
| |
| static int config(struct vf_instance *vf, |
| int width, int height, int d_width, int d_height, |
| unsigned int flags, unsigned int outfmt){ |
| |
| Init_2xSaI(outfmt&255); |
| |
| return vf_next_config(vf,2*width,2*height,2*d_width,2*d_height,flags,outfmt); |
| } |
| |
| static int put_image(struct vf_instance *vf, mp_image_t *mpi, double pts){ |
| mp_image_t *dmpi; |
| |
| // hope we'll get DR buffer: |
| dmpi=vf_get_image(vf->next,mpi->imgfmt, |
| MP_IMGTYPE_TEMP, MP_IMGFLAG_ACCEPT_STRIDE, |
| 2*mpi->w, 2*mpi->h); |
| |
| Super2xSaI_ex(mpi->planes[0], mpi->stride[0], |
| dmpi->planes[0], dmpi->stride[0], |
| mpi->w, mpi->h, mpi->bpp/8); |
| |
| return vf_next_put_image(vf,dmpi, pts); |
| } |
| |
| //===========================================================================// |
| |
| static int query_format(struct vf_instance *vf, unsigned int fmt){ |
| switch(fmt){ |
| // case IMGFMT_BGR15: |
| // case IMGFMT_BGR16: |
| case IMGFMT_BGR32: |
| return vf_next_query_format(vf,fmt); |
| } |
| return 0; |
| } |
| |
| static int vf_open(vf_instance_t *vf, char *args){ |
| vf->config=config; |
| vf->put_image=put_image; |
| vf->query_format=query_format; |
| return 1; |
| } |
| |
| const vf_info_t vf_info_2xsai = { |
| "2xSai BGR bitmap 2x scaler", |
| "2xsai", |
| "A'rpi", |
| "http://elektron.its.tudelft.nl/~dalikifa/", |
| vf_open, |
| NULL |
| }; |
| |
| //===========================================================================// |
