diff options
Diffstat (limited to 'gst/deinterlace2/tvtime/speedy.c')
| -rw-r--r-- | gst/deinterlace2/tvtime/speedy.c | 2791 |
1 files changed, 0 insertions, 2791 deletions
diff --git a/gst/deinterlace2/tvtime/speedy.c b/gst/deinterlace2/tvtime/speedy.c deleted file mode 100644 index d19d917f..00000000 --- a/gst/deinterlace2/tvtime/speedy.c +++ /dev/null @@ -1,2791 +0,0 @@ -/* - * Copyright (c) 2002, 2003 Billy Biggs <vektor@dumbterm.net>. - * Copyright (C) 2001 Matthew J. Marjanovic <maddog@mir.com> - * - * This program 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, or (at your option) - * any later version. - * - * This program 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 this program; if not, write to the Free Software Foundation, - * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. - */ - -/* - * Includes 420to422, 422to444 scaling filters from the MPEG2 reference - * implementation. The v12 source code indicates that they were written - * by Cheung Auyeung <auyeung@mot.com>. The file they were in was: - * - * store.c, picture output routines - * Copyright (C) 1996, MPEG Software Simulation Group. All Rights Reserved. - * - * Disclaimer of Warranty - * - * These software programs are available to the user without any license fee or - * royalty on an "as is" basis. The MPEG Software Simulation Group disclaims - * any and all warranties, whether express, implied, or statuary, including any - * implied warranties or merchantability or of fitness for a particular - * purpose. In no event shall the copyright-holder be liable for any - * incidental, punitive, or consequential damages of any kind whatsoever - * arising from the use of these programs. - * - * This disclaimer of warranty extends to the user of these programs and user's - * customers, employees, agents, transferees, successors, and assigns. - * - * The MPEG Software Simulation Group does not represent or warrant that the - * programs furnished hereunder are free of infringement of any third-party - * patents. - * - * Commercial implementations of MPEG-1 and MPEG-2 video, including shareware, - * are subject to royalty fees to patent holders. Many of these patents are - * general enough such that they are unavoidable regardless of implementation - * design. - * - */ - -/* - * Code for the UYVY to YUYV routine comes from rivatv: - * - * rivatv-convert.c video image conversion routines - * - * Copyright (C) 2002 Stefan Jahn <stefan@lkcc.org> - * - * This program 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. - * - * This program 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 this program; if not, write to the Free Software - * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. - */ - -#include <stdio.h> -#include <string.h> - -#ifdef HAVE_CONFIG_H -# include "config.h" -#endif - -#include "gst/gst.h" -#include "gstdeinterlace2.h" -#include "speedy.h" -#include "speedtools.h" -#include "mmx.h" -#include "sse.h" - -// TODO: remove includes -//#include "attributes.h" -//#include "mm_accel.h" - -/* Function pointer definitions. */ -void (*interpolate_packed422_scanline) (uint8_t * output, uint8_t * top, - uint8_t * bot, int width); -void (*blit_colour_packed422_scanline) (uint8_t * output, - int width, int y, int cb, int cr); -void (*blit_colour_packed4444_scanline) (uint8_t * output, - int width, int alpha, int luma, int cb, int cr); -void (*blit_packed422_scanline) (uint8_t * dest, const uint8_t * src, - int width); -void (*composite_packed4444_to_packed422_scanline) (uint8_t * output, - uint8_t * input, uint8_t * foreground, int width); -void (*composite_packed4444_alpha_to_packed422_scanline) (uint8_t * output, - uint8_t * input, uint8_t * foreground, int width, int alpha); -void (*composite_alphamask_to_packed4444_scanline) (uint8_t * output, - uint8_t * input, uint8_t * mask, int width, int textluma, int textcb, - int textcr); -void (*composite_alphamask_alpha_to_packed4444_scanline) (uint8_t * output, - uint8_t * input, uint8_t * mask, int width, int textluma, int textcb, - int textcr, int alpha); -void (*premultiply_packed4444_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*blend_packed422_scanline) (uint8_t * output, uint8_t * src1, - uint8_t * src2, int width, int pos); -unsigned int (*diff_factor_packed422_scanline) (uint8_t * cur, uint8_t * old, - int width); -unsigned int (*comb_factor_packed422_scanline) (uint8_t * top, uint8_t * mid, - uint8_t * bot, int width); -void (*kill_chroma_packed422_inplace_scanline) (uint8_t * data, int width); - -void (*mirror_packed422_inplace_scanline) (uint8_t * data, int width); - -void (*speedy_memcpy) (void *output, const void *input, size_t size); - -void (*diff_packed422_block8x8) (pulldown_metrics_t * m, uint8_t * old, - uint8_t * new, int os, int ns); -void (*a8_subpix_blit_scanline) (uint8_t * output, uint8_t * input, - int lasta, int startpos, int width); -void (*quarter_blit_vertical_packed422_scanline) (uint8_t * output, - uint8_t * one, uint8_t * three, int width); -void (*subpix_blit_vertical_packed422_scanline) (uint8_t * output, - uint8_t * top, uint8_t * bot, int subpixpos, int width); -void (*packed444_to_nonpremultiplied_packed4444_scanline) (uint8_t * output, - uint8_t * input, int width, int alpha); -void (*aspect_adjust_packed4444_scanline) (uint8_t * output, uint8_t * input, - int width, double pixel_aspect); -void (*packed444_to_packed422_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*packed422_to_packed444_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*packed422_to_packed444_rec601_scanline) (uint8_t * dest, uint8_t * src, - int width); -void (*packed444_to_rgb24_rec601_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*rgb24_to_packed444_rec601_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*rgba32_to_packed4444_rec601_scanline) (uint8_t * output, uint8_t * input, - int width); -void (*invert_colour_packed422_inplace_scanline) (uint8_t * data, int width); - -void (*vfilter_chroma_121_packed422_scanline) (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b); -void (*vfilter_chroma_332_packed422_scanline) (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b); -void (*convert_uyvy_to_yuyv_scanline) (uint8_t * uyvy_buf, uint8_t * yuyv_buf, - int width); -void (*composite_colour4444_alpha_to_packed422_scanline) (uint8_t * output, - uint8_t * input, int af, int y, int cb, int cr, int width, int alpha); - -/* - * result = (1 - alpha)B + alpha*F - * = B - alpha*B + alpha*F - * = B + alpha*(F - B) - */ - -static inline __attribute__ ((always_inline, const)) - int multiply_alpha (int a, int r) -{ - int temp; - - temp = (r * a) + 0x80; - return ((temp + (temp >> 8)) >> 8); -} - -static inline __attribute__ ((always_inline, const)) - uint8_t clip255 (int x) -{ - if (x > 255) { - return 255; - } else if (x < 0) { - return 0; - } else { - return x; - } -} - -unsigned long CombJaggieThreshold = 73; - -#ifdef HAVE_CPU_I386 -static unsigned int -comb_factor_packed422_scanline_mmx (uint8_t * top, uint8_t * mid, - uint8_t * bot, int width) -{ - const mmx_t qwYMask = { 0x00ff00ff00ff00ffULL }; - const mmx_t qwOnes = { 0x0001000100010001ULL }; - mmx_t qwThreshold; - - unsigned int temp1, temp2; - - width /= 4; - - qwThreshold.uw[0] = CombJaggieThreshold; - qwThreshold.uw[1] = CombJaggieThreshold; - qwThreshold.uw[2] = CombJaggieThreshold; - qwThreshold.uw[3] = CombJaggieThreshold; - - movq_m2r (qwThreshold, mm0); - movq_m2r (qwYMask, mm1); - movq_m2r (qwOnes, mm2); - pxor_r2r (mm7, mm7); /* mm7 = 0. */ - - while (width--) { - /* Load and keep just the luma. */ - movq_m2r (*top, mm3); - movq_m2r (*mid, mm4); - movq_m2r (*bot, mm5); - - pand_r2r (mm1, mm3); - pand_r2r (mm1, mm4); - pand_r2r (mm1, mm5); - - /* Work out mm6 = (top - mid) * (bot - mid) - ( (top - mid)^2 >> 7 ) */ - psrlw_i2r (1, mm3); - psrlw_i2r (1, mm4); - psrlw_i2r (1, mm5); - - /* mm6 = (top - mid) */ - movq_r2r (mm3, mm6); - psubw_r2r (mm4, mm6); - - /* mm3 = (top - bot) */ - psubw_r2r (mm5, mm3); - - /* mm5 = (bot - mid) */ - psubw_r2r (mm4, mm5); - - /* mm6 = (top - mid) * (bot - mid) */ - pmullw_r2r (mm5, mm6); - - /* mm3 = (top - bot)^2 >> 7 */ - pmullw_r2r (mm3, mm3); /* mm3 = (top - bot)^2 */ - psrlw_i2r (7, mm3); /* mm3 = ((top - bot)^2 >> 7) */ - - /* mm6 is what we want. */ - psubw_r2r (mm3, mm6); - - /* FF's if greater than qwTheshold */ - pcmpgtw_r2r (mm0, mm6); - - /* Add to count if we are greater than threshold */ - pand_r2r (mm2, mm6); - paddw_r2r (mm6, mm7); - - top += 8; - mid += 8; - bot += 8; - } - - movd_r2m (mm7, temp1); - psrlq_i2r (32, mm7); - movd_r2m (mm7, temp2); - temp1 += temp2; - temp2 = temp1; - temp1 >>= 16; - temp1 += temp2 & 0xffff; - - emms (); - - return temp1; -} -#endif - -static unsigned long BitShift = 6; - -static unsigned int -diff_factor_packed422_scanline_c (uint8_t * cur, uint8_t * old, int width) -{ - unsigned int ret = 0; - - width /= 4; - - while (width--) { - unsigned int tmp1 = (cur[0] + cur[2] + cur[4] + cur[6] + 2) >> 2; - - unsigned int tmp2 = (old[0] + old[2] + old[4] + old[6] + 2) >> 2; - - tmp1 = (tmp1 - tmp2); - tmp1 *= tmp1; - tmp1 >>= BitShift; - ret += tmp1; - cur += 8; - old += 8; - } - - return ret; -} - -/* -static unsigned int diff_factor_packed422_scanline_test_c( uint8_t *cur, uint8_t *old, int width ) -{ - unsigned int ret = 0; - - width /= 16; - - while( width-- ) { - unsigned int tmp1 = (cur[ 0 ] + cur[ 2 ] + cur[ 4 ] + cur[ 6 ])>>2; - unsigned int tmp2 = (old[ 0 ] + old[ 2 ] + old[ 4 ] + old[ 6 ])>>2; - tmp1 = (tmp1 - tmp2); - tmp1 *= tmp1; - tmp1 >>= BitShift; - ret += tmp1; - cur += (8*4); - old += (8*4); - } - - return ret; -} -*/ - -#ifdef HAVE_CPU_I386 -static unsigned int -diff_factor_packed422_scanline_mmx (uint8_t * cur, uint8_t * old, int width) -{ - const mmx_t qwYMask = { 0x00ff00ff00ff00ffULL }; - unsigned int temp1, temp2; - - width /= 4; - - movq_m2r (qwYMask, mm1); - movd_m2r (BitShift, mm7); - pxor_r2r (mm0, mm0); - - while (width--) { - movq_m2r (*cur, mm4); - movq_m2r (*old, mm5); - - pand_r2r (mm1, mm4); - pand_r2r (mm1, mm5); - - psubw_r2r (mm5, mm4); /* mm4 = Y1 - Y2 */ - pmaddwd_r2r (mm4, mm4); /* mm4 = (Y1 - Y2)^2 */ - psrld_r2r (mm7, mm4); /* divide mm4 by 2^BitShift */ - paddd_r2r (mm4, mm0); /* keep total in mm0 */ - - cur += 8; - old += 8; - } - - movd_r2m (mm0, temp1); - psrlq_i2r (32, mm0); - movd_r2m (mm0, temp2); - temp1 += temp2; - - emms (); - - return temp1; -} -#endif - -// defined in glib/gmacros.h #define ABS(a) (((a) < 0)?-(a):(a)) - -#ifdef HAVE_CPU_I386 -static void -diff_packed422_block8x8_mmx (pulldown_metrics_t * m, uint8_t * old, - uint8_t * new, int os, int ns) -{ - const mmx_t ymask = { 0x00ff00ff00ff00ffULL }; - short out[24]; /* Output buffer for the partial metrics from the mmx code. */ - - uint8_t *outdata = (uint8_t *) out; - - uint8_t *oldp, *newp; - - int i; - - pxor_r2r (mm4, mm4); // 4 even difference sums. - pxor_r2r (mm5, mm5); // 4 odd difference sums. - pxor_r2r (mm7, mm7); // zeros - - oldp = old; - newp = new; - for (i = 4; i; --i) { - // Even difference. - movq_m2r (oldp[0], mm0); - movq_m2r (oldp[8], mm2); - pand_m2r (ymask, mm0); - pand_m2r (ymask, mm2); - oldp += os; - - movq_m2r (newp[0], mm1); - movq_m2r (newp[8], mm3); - pand_m2r (ymask, mm1); - pand_m2r (ymask, mm3); - newp += ns; - - movq_r2r (mm0, mm6); - psubusb_r2r (mm1, mm0); - psubusb_r2r (mm6, mm1); - movq_r2r (mm2, mm6); - psubusb_r2r (mm3, mm2); - psubusb_r2r (mm6, mm3); - - paddw_r2r (mm0, mm4); - paddw_r2r (mm1, mm4); - paddw_r2r (mm2, mm4); - paddw_r2r (mm3, mm4); - - // Odd difference. - movq_m2r (oldp[0], mm0); - movq_m2r (oldp[8], mm2); - pand_m2r (ymask, mm0); - pand_m2r (ymask, mm2); - oldp += os; - - movq_m2r (newp[0], mm1); - movq_m2r (newp[8], mm3); - pand_m2r (ymask, mm1); - pand_m2r (ymask, mm3); - newp += ns; - - movq_r2r (mm0, mm6); - psubusb_r2r (mm1, mm0); - psubusb_r2r (mm6, mm1); - movq_r2r (mm2, mm6); - psubusb_r2r (mm3, mm2); - psubusb_r2r (mm6, mm3); - - paddw_r2r (mm0, mm5); - paddw_r2r (mm1, mm5); - paddw_r2r (mm2, mm5); - paddw_r2r (mm3, mm5); - } - movq_r2m (mm4, outdata[0]); - movq_r2m (mm5, outdata[8]); - - m->e = out[0] + out[1] + out[2] + out[3]; - m->o = out[4] + out[5] + out[6] + out[7]; - m->d = m->e + m->o; - - pxor_r2r (mm4, mm4); // Past spacial noise. - pxor_r2r (mm5, mm5); // Temporal noise. - pxor_r2r (mm6, mm6); // Current spacial noise. - - // First loop to measure first four columns - oldp = old; - newp = new; - for (i = 4; i; --i) { - movq_m2r (oldp[0], mm0); - movq_m2r (oldp[os], mm1); - pand_m2r (ymask, mm0); - pand_m2r (ymask, mm1); - oldp += (os * 2); - - movq_m2r (newp[0], mm2); - movq_m2r (newp[ns], mm3); - pand_m2r (ymask, mm2); - pand_m2r (ymask, mm3); - newp += (ns * 2); - - paddw_r2r (mm1, mm4); - paddw_r2r (mm1, mm5); - paddw_r2r (mm3, mm6); - psubw_r2r (mm0, mm4); - psubw_r2r (mm2, mm5); - psubw_r2r (mm2, mm6); - } - movq_r2m (mm4, outdata[0]); - movq_r2m (mm5, outdata[16]); - movq_r2m (mm6, outdata[32]); - - pxor_r2r (mm4, mm4); - pxor_r2r (mm5, mm5); - pxor_r2r (mm6, mm6); - - // Second loop for the last four columns - oldp = old; - newp = new; - for (i = 4; i; --i) { - movq_m2r (oldp[8], mm0); - movq_m2r (oldp[os + 8], mm1); - pand_m2r (ymask, mm0); - pand_m2r (ymask, mm1); - oldp += (os * 2); - - movq_m2r (newp[8], mm2); - movq_m2r (newp[ns + 8], mm3); - pand_m2r (ymask, mm2); - pand_m2r (ymask, mm3); - newp += (ns * 2); - - paddw_r2r (mm1, mm4); - paddw_r2r (mm1, mm5); - paddw_r2r (mm3, mm6); - psubw_r2r (mm0, mm4); - psubw_r2r (mm2, mm5); - psubw_r2r (mm2, mm6); - } - movq_r2m (mm4, outdata[8]); - movq_r2m (mm5, outdata[24]); - movq_r2m (mm6, outdata[40]); - - m->p = m->t = m->s = 0; - for (i = 0; i < 8; i++) { - // FIXME: move abs() into the mmx code! - m->p += ABS (out[i]); - m->t += ABS (out[8 + i]); - m->s += ABS (out[16 + i]); - } - - emms (); -} -#endif - -static void -diff_packed422_block8x8_c (pulldown_metrics_t * m, uint8_t * old, - uint8_t * new, int os, int ns) -{ - int x, y, e = 0, o = 0, s = 0, p = 0, t = 0; - - uint8_t *oldp, *newp; - - m->s = m->p = m->t = 0; - for (x = 8; x; x--) { - oldp = old; - old += 2; - newp = new; - new += 2; - s = p = t = 0; - for (y = 4; y; y--) { - e += ABS (newp[0] - oldp[0]); - o += ABS (newp[ns] - oldp[os]); - s += newp[ns] - newp[0]; - p += oldp[os] - oldp[0]; - t += oldp[os] - newp[0]; - oldp += os << 1; - newp += ns << 1; - } - m->s += ABS (s); - m->p += ABS (p); - m->t += ABS (t); - } - m->e = e; - m->o = o; - m->d = e + o; -} - -static void -packed444_to_packed422_scanline_c (uint8_t * output, uint8_t * input, int width) -{ - width /= 2; - while (width--) { - output[0] = input[0]; - output[1] = input[1]; - output[2] = input[3]; - output[3] = input[2]; - output += 4; - input += 6; - } -} - -static void -packed422_to_packed444_scanline_c (uint8_t * output, uint8_t * input, int width) -{ - width /= 2; - while (width--) { - output[0] = input[0]; - output[1] = input[1]; - output[2] = input[3]; - output[3] = input[2]; - output[4] = input[1]; - output[5] = input[3]; - output += 6; - input += 4; - } -} - -/* - * For the middle pixels, the filter kernel is: - * - * [-1 3 -6 12 -24 80 80 -24 12 -6 3 -1] - */ -static void -packed422_to_packed444_rec601_scanline_c (uint8_t * dest, uint8_t * src, - int width) -{ - int i; - - /* Process two input pixels at a time. Input is [Y'][Cb][Y'][Cr]. */ - for (i = 0; i < width / 2; i++) { - dest[(i * 6) + 0] = src[(i * 4) + 0]; - dest[(i * 6) + 1] = src[(i * 4) + 1]; - dest[(i * 6) + 2] = src[(i * 4) + 3]; - - dest[(i * 6) + 3] = src[(i * 4) + 2]; - if (i > (5 * 2) && i < ((width / 2) - (6 * 2))) { - dest[(i * 6) + 4] = - clip255 ((((80 * (src[(i * 4) + 1] + src[(i * 4) + 5])) - - (24 * (src[(i * 4) - 3] + src[(i * 4) + 9])) - + (12 * (src[(i * 4) - 7] + src[(i * 4) + 13])) - - (6 * (src[(i * 4) - 11] + src[(i * 4) + 17])) - + (3 * (src[(i * 4) - 15] + src[(i * 4) + 21])) - - ((src[(i * 4) - 19] + src[(i * 4) + 25]))) + 64) >> 7); - dest[(i * 6) + 5] = - clip255 ((((80 * (src[(i * 4) + 3] + src[(i * 4) + 7])) - - (24 * (src[(i * 4) - 1] + src[(i * 4) + 11])) - + (12 * (src[(i * 4) - 5] + src[(i * 4) + 15])) - - (6 * (src[(i * 4) - 9] + src[(i * 4) + 19])) - + (3 * (src[(i * 4) - 13] + src[(i * 4) + 23])) - - ((src[(i * 4) - 17] + src[(i * 4) + 27]))) + 64) >> 7); - } else if (i < ((width / 2) - 1)) { - dest[(i * 6) + 4] = (src[(i * 4) + 1] + src[(i * 4) + 5] + 1) >> 1; - dest[(i * 6) + 5] = (src[(i * 4) + 3] + src[(i * 4) + 7] + 1) >> 1; - } else { - dest[(i * 6) + 4] = src[(i * 4) + 1]; - dest[(i * 6) + 5] = src[(i * 4) + 3]; - } - } -} - -#ifdef HAVE_CPU_I386 -static void -vfilter_chroma_121_packed422_scanline_mmx (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b) -{ - int i; - const mmx_t ymask = { 0x00ff00ff00ff00ffULL }; - const mmx_t cmask = { 0xff00ff00ff00ff00ULL }; - - // Get width in bytes. - width *= 2; - i = width / 8; - width -= i * 8; - - movq_m2r (ymask, mm7); - movq_m2r (cmask, mm6); - - while (i--) { - movq_m2r (*t, mm0); - movq_m2r (*b, mm1); - movq_m2r (*m, mm2); - - movq_r2r (mm2, mm3); - pand_r2r (mm7, mm3); - - pand_r2r (mm6, mm0); - pand_r2r (mm6, mm1); - pand_r2r (mm6, mm2); - - psrlq_i2r (8, mm0); - psrlq_i2r (8, mm1); - psrlq_i2r (7, mm2); - - paddw_r2r (mm0, mm2); - paddw_r2r (mm1, mm2); - - psllw_i2r (6, mm2); - pand_r2r (mm6, mm2); - - por_r2r (mm3, mm2); - - movq_r2m (mm2, *output); - output += 8; - t += 8; - b += 8; - m += 8; - } - output++; - t++; - b++; - m++; - while (width--) { - *output = (*t + *b + (*m << 1)) >> 2; - output += 2; - t += 2; - b += 2; - m += 2; - } - - emms (); -} -#endif - -static void -vfilter_chroma_121_packed422_scanline_c (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b) -{ - output++; - t++; - b++; - m++; - while (width--) { - *output = (*t + *b + (*m << 1)) >> 2; - output += 2; - t += 2; - b += 2; - m += 2; - } -} - -#ifdef HAVE_CPU_I386 -static void -vfilter_chroma_332_packed422_scanline_mmx (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b) -{ - int i; - const mmx_t ymask = { 0x00ff00ff00ff00ffULL }; - const mmx_t cmask = { 0xff00ff00ff00ff00ULL }; - - // Get width in bytes. - width *= 2; - i = width / 8; - width -= i * 8; - - movq_m2r (ymask, mm7); - movq_m2r (cmask, mm6); - - while (i--) { - movq_m2r (*t, mm0); - movq_m2r (*b, mm1); - movq_m2r (*m, mm2); - - movq_r2r (mm2, mm3); - pand_r2r (mm7, mm3); - - pand_r2r (mm6, mm0); - pand_r2r (mm6, mm1); - pand_r2r (mm6, mm2); - - psrlq_i2r (8, mm0); - psrlq_i2r (7, mm1); - psrlq_i2r (8, mm2); - - movq_r2r (mm0, mm4); - psllw_i2r (1, mm4); - paddw_r2r (mm4, mm0); - - movq_r2r (mm2, mm4); - psllw_i2r (1, mm4); - paddw_r2r (mm4, mm2); - - paddw_r2r (mm0, mm2); - paddw_r2r (mm1, mm2); - - psllw_i2r (5, mm2); - pand_r2r (mm6, mm2); - - por_r2r (mm3, mm2); - - movq_r2m (mm2, *output); - output += 8; - t += 8; - b += 8; - m += 8; - } - output++; - t++; - b++; - m++; - while (width--) { - *output = (3 * *t + 3 * *m + 2 * *b) >> 3; - output += 2; - t += 2; - b += 2; - m += 2; - } - - emms (); -} -#endif - -static void -vfilter_chroma_332_packed422_scanline_c (uint8_t * output, int width, - uint8_t * m, uint8_t * t, uint8_t * b) -{ - output++; - t++; - b++; - m++; - while (width--) { - *output = (3 * *t + 3 * *m + 2 * *b) >> 3; - output += 2; - t += 2; - b += 2; - m += 2; - } -} - -#ifdef HAVE_CPU_I386 -static void -kill_chroma_packed422_inplace_scanline_mmx (uint8_t * data, int width) -{ - const mmx_t ymask = { 0x00ff00ff00ff00ffULL }; - const mmx_t nullchroma = { 0x8000800080008000ULL }; - - movq_m2r (ymask, mm7); - movq_m2r (nullchroma, mm6); - for (; width > 4; width -= 4) { - movq_m2r (*data, mm0); - pand_r2r (mm7, mm0); - paddb_r2r (mm6, mm0); - movq_r2m (mm0, *data); - data += 8; - } - emms (); - - while (width--) { - data[1] = 128; - data += 2; - } -} -#endif - -static void -kill_chroma_packed422_inplace_scanline_c (uint8_t * data, int width) -{ - while (width--) { - data[1] = 128; - data += 2; - } -} - -#ifdef HAVE_CPU_I386 -static void -invert_colour_packed422_inplace_scanline_mmx (uint8_t * data, int width) -{ - const mmx_t allones = { 0xffffffffffffffffULL }; - - movq_m2r (allones, mm1); - for (; width > 4; width -= 4) { - movq_r2r (mm1, mm2); - movq_m2r (*data, mm0); - psubb_r2r (mm0, mm2); - movq_r2m (mm2, *data); - data += 8; - } - emms (); - - width *= 2; - while (width--) { - *data = 255 - *data; - data++; - } -} -#endif - -static void -invert_colour_packed422_inplace_scanline_c (uint8_t * data, int width) -{ - width *= 2; - while (width--) { - *data = 255 - *data; - data++; - } -} - -static void -mirror_packed422_inplace_scanline_c (uint8_t * data, int width) -{ - int x, tmp1, tmp2; - - int width2 = width * 2; - - for (x = 0; x < width; x += 2) { - tmp1 = data[x]; - tmp2 = data[x + 1]; - data[x] = data[width2 - x]; - data[x + 1] = data[width2 - x + 1]; - data[width2 - x] = tmp1; - data[width2 - x + 1] = tmp2; - } -} - -static void -interpolate_packed422_scanline_c (uint8_t * output, uint8_t * top, - uint8_t * bot, int width) -{ - int i; - - for (i = width * 2; i; --i) { - *output++ = ((*top++) + (*bot++)) >> 1; - } -} - -#ifdef HAVE_CPU_I386 -static void -convert_uyvy_to_yuyv_scanline_mmx (uint8_t * uyvy_buf, uint8_t * yuyv_buf, - int width) -{ -#if defined(HAVE_CPU_I386) && !defined(HAVE_CPU_X86_64) - __asm__ __volatile__ (" movl %0, %%esi \n" - " movl %1, %%edi \n" - " movl %2, %%edx \n" " shrl $3, %%edx \n" - /* Process 8 pixels at once */ - "1: movq (%%esi), %%mm0 \n" /* mm0 = Y3V2Y2U2Y1V0Y0U0 */ - " movq 8(%%esi), %%mm2 \n" /* mm2 = Y7V6Y6U6Y5V4Y4U4 */ - " movq %%mm0, %%mm1 \n" /* mm1 = Y3V2Y2U2Y1V0Y0U0 */ - " movq %%mm2, %%mm3 \n" /* mm3 = Y7V6Y6U6Y5V4Y4U4 */ - " psllw $8, %%mm0 \n" /* mm0 = V2__U2__V0__U0__ */ - " psrlw $8, %%mm1 \n" /* mm1 = __Y3__Y2__Y1__Y0 */ - " psllw $8, %%mm2 \n" /* mm2 = V6__U6__V4__U4__ */ - " psrlw $8, %%mm3 \n" /* mm3 = __Y7__Y6__Y5__Y4 */ - " por %%mm1, %%mm0 \n" /* mm0 = V2Y3U2Y2V0Y1U0Y0 */ - " por %%mm3, %%mm2 \n" /* mm2 = V6Y7U6Y6V4Y5U4Y4 */ - " movq %%mm0, (%%edi) \n" - " movq %%mm2, 8(%%edi) \n" - " addl $16, %%esi \n" - " addl $16, %%edi \n" - " decl %%edx \n" - " jnz 1b \n" " emms \n" - /* output */ : - /* input */ :"g" (uyvy_buf), "g" (yuyv_buf), "g" (width) - /* clobber registers */ - :"cc", "edx", "esi", "edi"); -#endif -#ifdef HAVE_CPU_X86_64 - __asm__ __volatile__ (" movq %0, %%rsi \n" - " movq %1, %%rdi \n" - " xorq %%rdx, %%rdx \n" - " movl %2, %%edx \n" " shrq $3, %%rdx \n" - /* Process 8 pixels at once */ - "1: movq (%%rsi), %%mm0 \n" /* mm0 = Y3V2Y2U2Y1V0Y0U0 */ - " movq 8(%%rsi), %%mm2 \n" /* mm2 = Y7V6Y6U6Y5V4Y4U4 */ - " movq %%mm0, %%mm1 \n" /* mm1 = Y3V2Y2U2Y1V0Y0U0 */ - " movq %%mm2, %%mm3 \n" /* mm3 = Y7V6Y6U6Y5V4Y4U4 */ - " psllw $8, %%mm0 \n" /* mm0 = V2__U2__V0__U0__ */ - " psrlw $8, %%mm1 \n" /* mm1 = __Y3__Y2__Y1__Y0 */ - " psllw $8, %%mm2 \n" /* mm2 = V6__U6__V4__U4__ */ - " psrlw $8, %%mm3 \n" /* mm3 = __Y7__Y6__Y5__Y4 */ - " por %%mm1, %%mm0 \n" /* mm0 = V2Y3U2Y2V0Y1U0Y0 */ - " por %%mm3, %%mm2 \n" /* mm2 = V6Y7U6Y6V4Y5U4Y4 */ - " movq %%mm0, (%%rdi) \n" - " movq %%mm2, 8(%%rdi) \n" - " addq $16, %%rsi \n" - " addq $16, %%rdi \n" - " decq %%rdx \n" - " jnz 1b \n" " emms \n" - /* output */ : - /* input */ :"g" (uyvy_buf), "g" (yuyv_buf), "g" (width) - /* clobber registers */ - :"cc", "rdx", "rsi", "rdi"); -#endif - if (width & 7) { - uint32_t *uyvy = (uint32_t *) uyvy_buf; - - uint32_t *yuyv = (uint32_t *) yuyv_buf; - - uint32_t val; - - width &= 7; - width >>= 1; - while (width--) { - val = *uyvy++; - val = ((val << 8) & ~0x00FF0000) | ((val >> 8) & ~0x0000FF00); - *yuyv++ = val; - } - } -} -#endif - -static void -convert_uyvy_to_yuyv_scanline_c (uint8_t * uyvy_buf, uint8_t * yuyv_buf, - int width) -{ - uint32_t *uyvy = (uint32_t *) uyvy_buf; - - uint32_t *yuyv = (uint32_t *) yuyv_buf; - - uint32_t val; - - width >>= 1; - while (width--) { - val = *uyvy++; - val = ((val << 8) & ~0x00FF0000) | ((val >> 8) & ~0x0000FF00); - *yuyv++ = val; - } -} - - -#ifdef HAVE_CPU_I386 -static void -interpolate_packed422_scanline_mmx (uint8_t * output, uint8_t * top, - uint8_t * bot, int width) -{ - const mmx_t shiftmask = { 0xfefffefffefffeffULL }; /* To avoid shifting chroma to luma. */ - int i; - - for (i = width / 16; i; --i) { - movq_m2r (*bot, mm0); - movq_m2r (*top, mm1); - movq_m2r (*(bot + 8), mm2); - movq_m2r (*(top + 8), mm3); - movq_m2r (*(bot + 16), mm4); - movq_m2r (*(top + 16), mm5); - movq_m2r (*(bot + 24), mm6); - movq_m2r (*(top + 24), mm7); - pand_m2r (shiftmask, mm0); - pand_m2r (shiftmask, mm1); - pand_m2r (shiftmask, mm2); - pand_m2r (shiftmask, mm3); - pand_m2r (shiftmask, mm4); - pand_m2r (shiftmask, mm5); - pand_m2r (shiftmask, mm6); - pand_m2r (shiftmask, mm7); - psrlw_i2r (1, mm0); - psrlw_i2r (1, mm1); - psrlw_i2r (1, mm2); - psrlw_i2r (1, mm3); - psrlw_i2r (1, mm4); - psrlw_i2r (1, mm5); - psrlw_i2r (1, mm6); - psrlw_i2r (1, mm7); - paddb_r2r (mm1, mm0); - paddb_r2r (mm3, mm2); - paddb_r2r (mm5, mm4); - paddb_r2r (mm7, mm6); - movq_r2m (mm0, *output); - movq_r2m (mm2, *(output + 8)); - movq_r2m (mm4, *(output + 16)); - movq_r2m (mm6, *(output + 24)); - output += 32; - top += 32; - bot += 32; - } - width = (width & 0xf); - - for (i = width / 4; i; --i) { - movq_m2r (*bot, mm0); - movq_m2r (*top, mm1); - pand_m2r (shiftmask, mm0); - pand_m2r (shiftmask, mm1); - psrlw_i2r (1, mm0); - psrlw_i2r (1, mm1); - paddb_r2r (mm1, mm0); - movq_r2m (mm0, *output); - output += 8; - top += 8; - bot += 8; - } - width = width & 0x7; - - /* Handle last few pixels. */ - for (i = width * 2; i; --i) { - *output++ = ((*top++) + (*bot++)) >> 1; - } - - emms (); -} -#endif - -#ifdef HAVE_CPU_I386 -static void -interpolate_packed422_scanline_mmxext (uint8_t * output, uint8_t * top, - uint8_t * bot, int width) -{ - int i; - - for (i = width / 16; i; --i) { - movq_m2r (*bot, mm0); - movq_m2r (*top, mm1); - movq_m2r (*(bot + 8), mm2); - movq_m2r (*(top + 8), mm3); - movq_m2r (*(bot + 16), mm4); - movq_m2r (*(top + 16), mm5); - movq_m2r (*(bot + 24), mm6); - movq_m2r (*(top + 24), mm7); - pavgb_r2r (mm1, mm0); - pavgb_r2r (mm3, mm2); - pavgb_r2r (mm5, mm4); - pavgb_r2r (mm7, mm6); - movntq_r2m (mm0, *output); - movntq_r2m (mm2, *(output + 8)); - movntq_r2m (mm4, *(output + 16)); - movntq_r2m (mm6, *(output + 24)); - output += 32; - top += 32; - bot += 32; - } - width = (width & 0xf); - - for (i = width / 4; i; --i) { - movq_m2r (*bot, mm0); - movq_m2r (*top, mm1); - pavgb_r2r (mm1, mm0); - movntq_r2m (mm0, *output); - output += 8; - top += 8; - bot += 8; - } - width = width & 0x7; - - /* Handle last few pixels. */ - for (i = width * 2; i; --i) { - *output++ = ((*top++) + (*bot++)) >> 1; - } - - sfence (); - emms (); -} -#endif - -static void -blit_colour_packed422_scanline_c (uint8_t * output, int width, int y, int cb, - int cr) -{ - uint32_t colour = cr << 24 | y << 16 | cb << 8 | y; - - uint32_t *o = (uint32_t *) output; - - for (width /= 2; width; --width) { - *o++ = colour; - } -} - -#ifdef HAVE_CPU_I386 -static void -blit_colour_packed422_scanline_mmx (uint8_t * output, int width, int y, int cb, - int cr) -{ - uint32_t colour = cr << 24 | y << 16 | cb << 8 | y; - - int i; - - movd_m2r (colour, mm1); - movd_m2r (colour, mm2); - psllq_i2r (32, mm1); - por_r2r (mm1, mm2); - - for (i = width / 16; i; --i) { - movq_r2m (mm2, *output); - movq_r2m (mm2, *(output + 8)); - movq_r2m (mm2, *(output + 16)); - movq_r2m (mm2, *(output + 24)); - output += 32; - } - width = (width & 0xf); - - for (i = width / 4; i; --i) { - movq_r2m (mm2, *output); - output += 8; - } - width = (width & 0x7); - - for (i = width / 2; i; --i) { - *((uint32_t *) output) = colour; - output += 4; - } - - if (width & 1) { - *output = y; - *(output + 1) = cb; - } - - emms (); -} -#endif - -#ifdef HAVE_CPU_I386 -static void -blit_colour_packed422_scanline_mmxext (uint8_t * output, int width, int y, - int cb, int cr) -{ - uint32_t colour = cr << 24 | y << 16 | cb << 8 | y; - - int i; - - movd_m2r (colour, mm1); - movd_m2r (colour, mm2); - psllq_i2r (32, mm1); - por_r2r (mm1, mm2); - - for (i = width / 16; i; --i) { - movntq_r2m (mm2, *output); - movntq_r2m (mm2, *(output + 8)); - movntq_r2m (mm2, *(output + 16)); - movntq_r2m (mm2, *(output + 24)); - output += 32; - } - width = (width & 0xf); - - for (i = width / 4; i; --i) { - movntq_r2m (mm2, *output); - output += 8; - } - width = (width & 0x7); - - for (i = width / 2; i; --i) { - *((uint32_t *) output) = colour; - output += 4; - } - - if (width & 1) { - *output = y; - *(output + 1) = cb; - } - - sfence (); - emms (); -} -#endif - -static void -blit_colour_packed4444_scanline_c (uint8_t * output, int width, - int alpha, int luma, int cb, int cr) -{ - int j; - - for (j = 0; j < width; j++) { - *output++ = alpha; - *output++ = luma; - *output++ = cb; - *output++ = cr; - } -} - -#ifdef HAVE_CPU_I386 -static void -blit_colour_packed4444_scanline_mmx (uint8_t * output, int width, - int alpha, int luma, int cb, int cr) -{ - uint32_t colour = (cr << 24) | (cb << 16) | (luma << 8) | alpha; - - int i; - - movd_m2r (colour, mm1); - movd_m2r (colour, mm2); - psllq_i2r (32, mm1); - por_r2r (mm1, mm2); - - for (i = width / 8; i; --i) { - movq_r2m (mm2, *output); - movq_r2m (mm2, *(output + 8)); - movq_r2m (mm2, *(output + 16)); - movq_r2m (mm2, *(output + 24)); - output += 32; - } - width = (width & 0x7); - - for (i = width / 2; i; --i) { - movq_r2m (mm2, *output); - output += 8; - } - width = (width & 0x1); - - if (width) { - *((uint32_t *) output) = colour; - output += 4; - } - - emms (); -} -#endif - -#ifdef HAVE_CPU_I386 -static void -blit_colour_packed4444_scanline_mmxext (uint8_t * output, int width, - int alpha, int luma, int cb, int cr) -{ - uint32_t colour = (cr << 24) | (cb << 16) | (luma << 8) | alpha; - - int i; - - movd_m2r (colour, mm1); - movd_m2r (colour, mm2); - psllq_i2r (32, mm1); - por_r2r (mm1, mm2); - - for (i = width / 8; i; --i) { - movntq_r2m (mm2, *output); - movntq_r2m (mm2, *(output + 8)); - movntq_r2m (mm2, *(output + 16)); - movntq_r2m (mm2, *(output + 24)); - output += 32; - } - width = (width & 0x7); - - for (i = width / 2; i; --i) { - movntq_r2m (mm2, *output); - output += 8; - } - width = (width & 0x1); - - if (width) { - *((uint32_t *) output) = colour; - output += 4; - } - - sfence (); - emms (); -} -#endif - - -/* - * Some memcpy code inspired by the xine code which originally came - * from mplayer. - */ - -/* linux kernel __memcpy (from: /include/asm/string.h) */ -#ifdef HAVE_CPU_I386 -static inline __attribute__ ((always_inline, const)) - void small_memcpy (void *to, const void *from, size_t n) -{ - int d0, d1, d2; - - __asm__ __volatile__ ("rep ; movsl\n\t" - "testb $2,%b4\n\t" - "je 1f\n\t" - "movsw\n" - "1:\ttestb $1,%b4\n\t" - "je 2f\n\t" "movsb\n" "2:":"=&c" (d0), "=&D" (d1), "=&S" (d2) - :"0" (n / 4), "q" (n), "1" ((long) to), "2" ((long) from) - :"memory"); -} -#endif - -static void -speedy_memcpy_c (void *dest, const void *src, size_t n) -{ - if (dest != src) { - memcpy (dest, src, n); - } -} - -#ifdef HAVE_CPU_I386 -static void -speedy_memcpy_mmx (void *d, const void *s, size_t n) -{ - const uint8_t *src = s; - - uint8_t *dest = d; - - if (dest != src) { - while (n > 64) { - movq_m2r (src[0], mm0); - movq_m2r (src[8], mm1); - movq_m2r (src[16], mm2); - movq_m2r (src[24], mm3); - movq_m2r (src[32], mm4); - movq_m2r (src[40], mm5); - movq_m2r (src[48], mm6); - movq_m2r (src[56], mm7); - movq_r2m (mm0, dest[0]); - movq_r2m (mm1, dest[8]); - movq_r2m (mm2, dest[16]); - movq_r2m (mm3, dest[24]); - movq_r2m (mm4, dest[32]); - movq_r2m (mm5, dest[40]); - movq_r2m (mm6, dest[48]); - movq_r2m (mm7, dest[56]); - dest += 64; - src += 64; - n -= 64; - } - - while (n > 8) { - movq_m2r (src[0], mm0); - movq_r2m (mm0, dest[0]); - dest += 8; - src += 8; - n -= 8; - } - - if (n) - small_memcpy (dest, src, n); - - emms (); - } -} -#endif - -#ifdef HAVE_CPU_I386 -static void -speedy_memcpy_mmxext (void *d, const void *s, size_t n) -{ - const uint8_t *src = s; - - uint8_t *dest = d; - - if (dest != src) { - while (n > 64) { - movq_m2r (src[0], mm0); - movq_m2r (src[8], mm1); - movq_m2r (src[16], mm2); - movq_m2r (src[24], mm3); - movq_m2r (src[32], mm4); - movq_m2r (src[40], mm5); - movq_m2r (src[48], mm6); - movq_m2r (src[56], mm7); - movntq_r2m (mm0, dest[0]); - movntq_r2m (mm1, dest[8]); - movntq_r2m (mm2, dest[16]); - movntq_r2m (mm3, dest[24]); - movntq_r2m (mm4, dest[32]); - movntq_r2m (mm5, dest[40]); - movntq_r2m (mm6, dest[48]); - movntq_r2m (mm7, dest[56]); - dest += 64; - src += 64; - n -= 64; - } - - while (n > 8) { - movq_m2r (src[0], mm0); - movntq_r2m (mm0, dest[0]); - dest += 8; - src += 8; - n -= 8; - } - - if (n) - small_memcpy (dest, src, n); - - sfence (); - emms (); - } -} -#endif - -static void -blit_packed422_scanline_c (uint8_t * dest, const uint8_t * src, int width) -{ - speedy_memcpy_c (dest, src, width * 2); -} - -#ifdef HAVE_CPU_I386 -static void -blit_packed422_scanline_mmx (uint8_t * dest, const uint8_t * src, int width) -{ - speedy_memcpy_mmx (dest, src, width * 2); -} -#endif - -#ifdef HAVE_CPU_I386 -static void -blit_packed422_scanline_mmxext (uint8_t * dest, const uint8_t * src, int width) -{ - speedy_memcpy_mmxext (dest, src, width * 2); -} -#endif - -static void -composite_colour4444_alpha_to_packed422_scanline_c (uint8_t * output, - uint8_t * input, int af, int y, int cb, int cr, int width, int alpha) -{ - int a = ((af * alpha) + 0x80) >> 8; - - if (a == 0xff) { - blit_colour_packed422_scanline (output, width, y, cb, cr); - } else if (a) { - int i; - - for (i = 0; i < width; i++) { - /* - * (1 - alpha)*B + alpha*F - * (1 - af*a)*B + af*a*F - * B - af*a*B + af*a*F - * B + a*(af*F - af*B) - */ - - output[0] = - input[0] + ((alpha * (y - multiply_alpha (af, - input[0])) + 0x80) >> 8); - - if ((i & 1) == 0) { - - /* - * At first I thought I was doing this incorrectly, but - * the following math has convinced me otherwise. - * - * C_r = (1 - alpha)*B + alpha*F - * C_r = B - af*a*B + af*a*F - * - * C_r = 128 + ((1 - af*a)*(B - 128) + a*af*(F - 128)) - * C_r = 128 + (B - af*a*B - 128 + af*a*128 + a*af*F - a*af*128) - * C_r = B - af*a*B + a*af*F - */ - - output[1] = - input[1] + ((alpha * (cb - multiply_alpha (af, - input[1])) + 0x80) >> 8); - output[3] = - input[3] + ((alpha * (cr - multiply_alpha (af, - input[3])) + 0x80) >> 8); - } - output += 2; - input += 2; - } - } -} - -#ifdef HAVE_CPU_I386 -static void -composite_colour4444_alpha_to_packed422_scanline_mmxext (uint8_t * output, - uint8_t * input, int af, int y, int cb, int cr, int width, int alpha) -{ - const mmx_t alpha2 = { 0x0000FFFF00000000ULL }; - const mmx_t alpha1 = { 0xFFFF0000FFFFFFFFULL }; - const mmx_t round = { 0x0080008000800080ULL }; - mmx_t foreground; - - int i; - - if (!alpha) { - blit_packed422_scanline (output, input, width); - return; - } - - foreground.ub[0] = foreground.ub[4] = af; - foreground.ub[1] = foreground.ub[5] = y; - foreground.ub[2] = foreground.ub[6] = cb; - foreground.ub[3] = foreground.ub[7] = cr; - - movq_m2r (alpha, mm2); - pshufw_r2r (mm2, mm2, 0); - pxor_r2r (mm7, mm7); - - for (i = width / 2; i; i--) { - /* mm1 = [ cr ][ y ][ cb ][ y ] */ - movd_m2r (*input, mm1); - punpcklbw_r2r (mm7, mm1); - - movq_m2r (foreground, mm3); - movq_r2r (mm3, mm4); - punpcklbw_r2r (mm7, mm3); - punpckhbw_r2r (mm7, mm4); - /* mm3 and mm4 will be the appropriate colours, mm5 and mm6 for alpha. */ - - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 0 a ][ 0 a ][ 0 a ] */ - pshufw_r2r (mm3, mm5, 0); - pshufw_r2r (mm4, mm6, 0); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 3 cr ][ 0 a ][ 2 cb ][ 1 y ] == 11001000 == 201 */ - pshufw_r2r (mm3, mm3, 201); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 1 y ][ 0 a ][ 0 a ] == 00010000 == 16 */ - pshufw_r2r (mm4, mm4, 16); - - pand_m2r (alpha1, mm3); - pand_m2r (alpha2, mm4); - pand_m2r (alpha1, mm5); - pand_m2r (alpha2, mm6); - por_r2r (mm4, mm3); - por_r2r (mm6, mm5); - - /* now, mm5 is af and mm1 is B. Need to multiply them. */ - pmullw_r2r (mm1, mm5); - - /* Multiply by appalpha. */ - pmullw_r2r (mm2, mm3); - paddw_m2r (round, mm3); - psrlw_i2r (8, mm3); - /* Result is now B + F. */ - paddw_r2r (mm3, mm1); - - /* Round up appropriately. */ - paddw_m2r (round, mm5); - - /* mm6 contains our i>>8; */ - movq_r2r (mm5, mm6); - psrlw_i2r (8, mm6); - - /* Add mm6 back into mm5. Now our result is in the high bytes. */ - paddw_r2r (mm6, mm5); - - /* Shift down. */ - psrlw_i2r (8, mm5); - - /* Multiply by appalpha. */ - pmullw_r2r (mm2, mm5); - paddw_m2r (round, mm5); - psrlw_i2r (8, mm5); - - psubusw_r2r (mm5, mm1); - - /* mm1 = [ B + F - af*B ] */ - packuswb_r2r (mm1, mm1); - movd_r2m (mm1, *output); - - output += 4; - input += 4; - } - sfence (); - emms (); -} -#endif - - -static void -composite_packed4444_alpha_to_packed422_scanline_c (uint8_t * output, - uint8_t * input, uint8_t * foreground, int width, int alpha) -{ - int i; - - for (i = 0; i < width; i++) { - int af = foreground[0]; - - if (af) { - int a = ((af * alpha) + 0x80) >> 8; - - - if (a == 0xff) { - output[0] = foreground[1]; - - if ((i & 1) == 0) { - output[1] = foreground[2]; - output[3] = foreground[3]; - } - } else if (a) { - /* - * (1 - alpha)*B + alpha*F - * (1 - af*a)*B + af*a*F - * B - af*a*B + af*a*F - * B + a*(af*F - af*B) - */ - - output[0] = input[0] - + ((alpha * (foreground[1] - - multiply_alpha (foreground[0], input[0])) + 0x80) >> 8); - - if ((i & 1) == 0) { - - /* - * At first I thought I was doing this incorrectly, but - * the following math has convinced me otherwise. - * - * C_r = (1 - alpha)*B + alpha*F - * C_r = B - af*a*B + af*a*F - * - * C_r = 128 + ((1 - af*a)*(B - 128) + a*af*(F - 128)) - * C_r = 128 + (B - af*a*B - 128 + af*a*128 + a*af*F - a*af*128) - * C_r = B - af*a*B + a*af*F - */ - - output[1] = input[1] + ((alpha * (foreground[2] - - multiply_alpha (foreground[0], input[1])) + 0x80) >> 8); - output[3] = input[3] + ((alpha * (foreground[3] - - multiply_alpha (foreground[0], input[3])) + 0x80) >> 8); - } - } - } - foreground += 4; - output += 2; - input += 2; - } -} - -#ifdef HAVE_CPU_I386 -static void -composite_packed4444_alpha_to_packed422_scanline_mmxext (uint8_t * output, - uint8_t * input, uint8_t * foreground, int width, int alpha) -{ - const mmx_t alpha2 = { 0x0000FFFF00000000ULL }; - const mmx_t alpha1 = { 0xFFFF0000FFFFFFFFULL }; - const mmx_t round = { 0x0080008000800080ULL }; - int i; - - if (!alpha) { - blit_packed422_scanline (output, input, width); - return; - } - - if (alpha == 256) { - composite_packed4444_to_packed422_scanline (output, input, foreground, - width); - return; - } - - READ_PREFETCH_2048 (input); - READ_PREFETCH_2048 (foreground); - - movq_m2r (alpha, mm2); - pshufw_r2r (mm2, mm2, 0); - pxor_r2r (mm7, mm7); - - for (i = width / 2; i; i--) { - int fg1 = *((uint32_t *) foreground); - - int fg2 = *(((uint32_t *) foreground) + 1); - - if (fg1 || fg2) { - /* mm1 = [ cr ][ y ][ cb ][ y ] */ - movd_m2r (*input, mm1); - punpcklbw_r2r (mm7, mm1); - - movq_m2r (*foreground, mm3); - movq_r2r (mm3, mm4); - punpcklbw_r2r (mm7, mm3); - punpckhbw_r2r (mm7, mm4); - /* mm3 and mm4 will be the appropriate colours, mm5 and mm6 for alpha. */ - - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 0 a ][ 0 a ][ 0 a ] */ - pshufw_r2r (mm3, mm5, 0); - pshufw_r2r (mm4, mm6, 0); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 3 cr ][ 0 a ][ 2 cb ][ 1 y ] == 11001000 == 201 */ - pshufw_r2r (mm3, mm3, 201); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 1 y ][ 0 a ][ 0 a ] == 00010000 == 16 */ - pshufw_r2r (mm4, mm4, 16); - - pand_m2r (alpha1, mm3); - pand_m2r (alpha2, mm4); - pand_m2r (alpha1, mm5); - pand_m2r (alpha2, mm6); - por_r2r (mm4, mm3); - por_r2r (mm6, mm5); - - /* now, mm5 is af and mm1 is B. Need to multiply them. */ - pmullw_r2r (mm1, mm5); - - /* Multiply by appalpha. */ - pmullw_r2r (mm2, mm3); - paddw_m2r (round, mm3); - psrlw_i2r (8, mm3); - /* Result is now B + F. */ - paddw_r2r (mm3, mm1); - - /* Round up appropriately. */ - paddw_m2r (round, mm5); - - /* mm6 contains our i>>8; */ - movq_r2r (mm5, mm6); - psrlw_i2r (8, mm6); - - /* Add mm6 back into mm5. Now our result is in the high bytes. */ - paddw_r2r (mm6, mm5); - - /* Shift down. */ - psrlw_i2r (8, mm5); - - /* Multiply by appalpha. */ - pmullw_r2r (mm2, mm5); - paddw_m2r (round, mm5); - psrlw_i2r (8, mm5); - - psubusw_r2r (mm5, mm1); - - /* mm1 = [ B + F - af*B ] */ - packuswb_r2r (mm1, mm1); - movd_r2m (mm1, *output); - } - - foreground += 8; - output += 4; - input += 4; - } - sfence (); - emms (); -} -#endif - -static void -composite_packed4444_to_packed422_scanline_c (uint8_t * output, uint8_t * input, - uint8_t * foreground, int width) -{ - int i; - - for (i = 0; i < width; i++) { - int a = foreground[0]; - - if (a == 0xff) { - output[0] = foreground[1]; - - if ((i & 1) == 0) { - output[1] = foreground[2]; - output[3] = foreground[3]; - } - } else if (a) { - /* - * (1 - alpha)*B + alpha*F - * B + af*F - af*B - */ - - output[0] = - input[0] + foreground[1] - multiply_alpha (foreground[0], input[0]); - - if ((i & 1) == 0) { - - /* - * C_r = (1 - af)*B + af*F - * C_r = B - af*B + af*F - */ - - output[1] = - input[1] + foreground[2] - multiply_alpha (foreground[0], input[1]); - output[3] = - input[3] + foreground[3] - multiply_alpha (foreground[0], input[3]); - } - } - foreground += 4; - output += 2; - input += 2; - } -} - - -#ifdef HAVE_CPU_I386 -static void -composite_packed4444_to_packed422_scanline_mmxext (uint8_t * output, - uint8_t * input, uint8_t * foreground, int width) -{ - const mmx_t alpha2 = { 0x0000FFFF00000000ULL }; - const mmx_t alpha1 = { 0xFFFF0000FFFFFFFFULL }; - const mmx_t round = { 0x0080008000800080ULL }; - int i; - - READ_PREFETCH_2048 (input); - READ_PREFETCH_2048 (foreground); - - pxor_r2r (mm7, mm7); - for (i = width / 2; i; i--) { - int fg1 = *((uint32_t *) foreground); - - int fg2 = *(((uint32_t *) foreground) + 1); - - if ((fg1 & 0xff) == 0xff && (fg2 & 0xff) == 0xff) { - movq_m2r (*foreground, mm3); - movq_r2r (mm3, mm4); - punpcklbw_r2r (mm7, mm3); - punpckhbw_r2r (mm7, mm4); - /* mm3 and mm4 will be the appropriate colours, mm5 and mm6 for alpha. */ - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 3 cr ][ 0 a ][ 2 cb ][ 1 y ] == 11001000 == 201 */ - pshufw_r2r (mm3, mm3, 201); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 1 y ][ 0 a ][ 0 a ] == 00010000 == 16 */ - pshufw_r2r (mm4, mm4, 16); - pand_m2r (alpha1, mm3); - pand_m2r (alpha2, mm4); - por_r2r (mm4, mm3); - /* mm1 = [ B + F - af*B ] */ - packuswb_r2r (mm3, mm3); - movd_r2m (mm3, *output); - } else if (fg1 || fg2) { - - /* mm1 = [ cr ][ y ][ cb ][ y ] */ - movd_m2r (*input, mm1); - punpcklbw_r2r (mm7, mm1); - - movq_m2r (*foreground, mm3); - movq_r2r (mm3, mm4); - punpcklbw_r2r (mm7, mm3); - punpckhbw_r2r (mm7, mm4); - /* mm3 and mm4 will be the appropriate colours, mm5 and mm6 for alpha. */ - - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 0 a ][ 0 a ][ 0 a ] */ - pshufw_r2r (mm3, mm5, 0); - pshufw_r2r (mm4, mm6, 0); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 3 cr ][ 0 a ][ 2 cb ][ 1 y ] == 11001000 == 201 */ - pshufw_r2r (mm3, mm3, 201); - /* [ 3 cr ][ 2 cb ][ 1 y ][ 0 a ] -> [ 0 a ][ 1 y ][ 0 a ][ 0 a ] == 00010000 == 16 */ - pshufw_r2r (mm4, mm4, 16); - - pand_m2r (alpha1, mm3); - pand_m2r (alpha2, mm4); - pand_m2r (alpha1, mm5); - pand_m2r (alpha2, mm6); - por_r2r (mm4, mm3); - por_r2r (mm6, mm5); - - /* now, mm5 is af and mm1 is B. Need to multiply them. */ - pmullw_r2r (mm1, mm5); - - /* Result is now B + F. */ - paddw_r2r (mm3, mm1); - - /* Round up appropriately. */ - paddw_m2r (round, mm5); - - /* mm6 contains our i>>8; */ - movq_r2r (mm5, mm6); - psrlw_i2r (8, mm6); - - /* Add mm6 back into mm5. Now our result is in the high bytes. */ - paddw_r2r (mm6, mm5); - - /* Shift down. */ - psrlw_i2r (8, mm5); - - psubusw_r2r (mm5, mm1); - - /* mm1 = [ B + F - af*B ] */ - packuswb_r2r (mm1, mm1); - movd_r2m (mm1, *output); - } - - foreground += 8; - output += 4; - input += 4; - } - sfence (); - emms (); -} -#endif - -/* - * um... just need some scrap paper... - * D = (1 - alpha)*B + alpha*F - * D = (1 - a)*B + a*textluma - * = B - a*B + a*textluma - * = B + a*(textluma - B) - * Da = (1 - a)*b + a - */ -static void -composite_alphamask_to_packed4444_scanline_c (uint8_t * output, - uint8_t * input, - uint8_t * mask, int width, int textluma, int textcb, int textcr) -{ - uint32_t opaque = (textcr << 24) | (textcb << 16) | (textluma << 8) | 0xff; - - int i; - - for (i = 0; i < width; i++) { - int a = *mask; - - if (a == 0xff) { - *((uint32_t *) output) = opaque; - } else if ((input[0] == 0x00)) { - *((uint32_t *) output) = (multiply_alpha (a, textcr) << 24) - | (multiply_alpha (a, textcb) << 16) - | (multiply_alpha (a, textluma) << 8) | a; - } else if (a) { - *((uint32_t *) output) = - ((input[3] + multiply_alpha (a, textcr - input[3])) << 24) - | ((input[2] + multiply_alpha (a, textcb - input[2])) << 16) - | ((input[1] + multiply_alpha (a, textluma - input[1])) << 8) - | (input[0] + multiply_alpha (a, 0xff - input[0])); - } - mask++; - output += 4; - input += 4; - } -} - -#ifdef HAVE_CPU_I386 -static void -composite_alphamask_to_packed4444_scanline_mmxext (uint8_t * output, - uint8_t * input, - uint8_t * mask, int width, int textluma, int textcb, int textcr) -{ - uint32_t opaque = (textcr << 24) | (textcb << 16) | (textluma << 8) | 0xff; - const mmx_t round = { 0x0080008000800080ULL }; - const mmx_t fullalpha = { 0x00000000000000ffULL }; - mmx_t colour; - - colour.w[0] = 0x00; - colour.w[1] = textluma; - colour.w[2] = textcb; - colour.w[3] = textcr; - - movq_m2r (colour, mm1); - movq_r2r (mm1, mm0); - - /* mm0 = [ cr ][ cb ][ y ][ 0xff ] */ - paddw_m2r (fullalpha, mm0); - - /* mm7 = 0 */ - pxor_r2r (mm7, mm7); - - /* mm6 = round */ - movq_m2r (round, mm6); - - while (width--) { - int a = *mask; - - if (a == 0xff) { - *((uint32_t *) output) = opaque; - } else if ((input[0] == 0x00)) { - /* We just need to multiply our colour by the alpha value. */ - - /* mm2 = [ a ][ a ][ a ][ a ] */ - movd_m2r (a, mm2); - movq_r2r (mm2, mm3); - pshufw_r2r (mm2, mm2, 0); - - /* mm5 = [ cr ][ cb ][ y ][ 0 ] */ - movq_r2r (mm1, mm5); - - /* Multiply by alpha. */ - pmullw_r2r (mm2, mm5); - paddw_m2r (round, mm5); - movq_r2r (mm5, mm6); - psrlw_i2r (8, mm6); - paddw_r2r (mm6, mm5); - psrlw_i2r (8, mm5); - - /* Set alpha to a. */ - por_r2r (mm3, mm5); - - /* Pack and write our result. */ - packuswb_r2r (mm5, mm5); - movd_r2m (mm5, *output); - } else if (a) { - /* mm2 = [ a ][ a ][ a ][ a ] */ - movd_m2r (a, mm2); - pshufw_r2r (mm2, mm2, 0); - - /* mm3 = [ cr ][ cb ][ y ][ 0xff ] */ - movq_r2r (mm0, mm3); - - /* mm4 = [ i_cr ][ i_cb ][ i_y ][ i_a ] */ - movd_m2r (*input, mm4); - punpcklbw_r2r (mm7, mm4); - - /* Subtract input and colour. */ - psubw_r2r (mm4, mm3); /* mm3 = mm3 - mm4 */ - - /* Multiply alpha. */ - pmullw_r2r (mm2, mm3); - paddw_r2r (mm6, mm3); - movq_r2r (mm3, mm2); - psrlw_i2r (8, mm3); - paddw_r2r (mm2, mm3); - psrlw_i2r (8, mm3); - - /* Add back in the input. */ - paddb_r2r (mm3, mm4); - - /* Write result. */ - packuswb_r2r (mm4, mm4); - movd_r2m (mm4, *output); - } - mask++; - output += 4; - input += 4; - } - sfence (); - emms (); -} -#endif - -static void -composite_alphamask_alpha_to_packed4444_scanline_c (uint8_t * output, - uint8_t * input, - uint8_t * mask, int width, int textluma, int textcb, int textcr, int alpha) -{ - uint32_t opaque = (textcr << 24) | (textcb << 16) | (textluma << 8) | 0xff; - - int i; - - for (i = 0; i < width; i++) { - int af = *mask; - - if (af) { - int a = ((af * alpha) + 0x80) >> 8; - - if (a == 0xff) { - *((uint32_t *) output) = opaque; - } else if (input[0] == 0x00) { - *((uint32_t *) output) = (multiply_alpha (a, textcr) << 24) - | (multiply_alpha (a, textcb) << 16) - | (multiply_alpha (a, textluma) << 8) | a; - } else if (a) { - *((uint32_t *) output) = - ((input[3] + multiply_alpha (a, textcr - input[3])) << 24) - | ((input[2] + multiply_alpha (a, textcb - input[2])) << 16) - | ((input[1] + multiply_alpha (a, textluma - input[1])) << 8) - | (a + multiply_alpha (0xff - a, input[0])); - } - } - mask++; - output += 4; - input += 4; - } -} - -static void -premultiply_packed4444_scanline_c (uint8_t * output, uint8_t * input, int width) -{ - while (width--) { - unsigned int cur_a = input[0]; - - *((uint32_t *) output) = (multiply_alpha (cur_a, input[3]) << 24) - | (multiply_alpha (cur_a, input[2]) << 16) - | (multiply_alpha (cur_a, input[1]) << 8) - | cur_a; - - output += 4; - input += 4; - } -} - -#ifdef HAVE_CPU_I386 -static void -premultiply_packed4444_scanline_mmxext (uint8_t * output, uint8_t * input, - int width) -{ - const mmx_t round = { 0x0080008000800080ULL }; - const mmx_t alpha = { 0x00000000000000ffULL }; - const mmx_t noalp = { 0xffffffffffff0000ULL }; - - pxor_r2r (mm7, mm7); - while (width--) { - movd_m2r (*input, mm0); - punpcklbw_r2r (mm7, mm0); - - movq_r2r (mm0, mm2); - pshufw_r2r (mm2, mm2, 0); - movq_r2r (mm2, mm4); - pand_m2r (alpha, mm4); - - pmullw_r2r (mm2, mm0); - paddw_m2r (round, mm0); - - movq_r2r (mm0, mm3); - psrlw_i2r (8, mm3); - paddw_r2r (mm3, mm0); - psrlw_i2r (8, mm0); - - pand_m2r (noalp, mm0); - paddw_r2r (mm4, mm0); - - packuswb_r2r (mm0, mm0); - movd_r2m (mm0, *output); - - output += 4; - input += 4; - } - sfence (); - emms (); -} -#endif - -static void -blend_packed422_scanline_c (uint8_t * output, uint8_t * src1, - uint8_t * src2, int width, int pos) -{ - if (pos == 0) { - blit_packed422_scanline (output, src1, width); - } else if (pos == 256) { - blit_packed422_scanline (output, src2, width); - } else if (pos == 128) { - interpolate_packed422_scanline (output, src1, src2, width); - } else { - width *= 2; - while (width--) { - *output++ = ((*src1++ * (256 - pos)) + (*src2++ * pos) + 0x80) >> 8; - } - } -} - -#ifdef HAVE_CPU_I386 -static void -blend_packed422_scanline_mmxext (uint8_t * output, uint8_t * src1, - uint8_t * src2, int width, int pos) -{ - if (pos <= 0) { - blit_packed422_scanline (output, src1, width); - } else if (pos >= 256) { - blit_packed422_scanline (output, src2, width); - } else if (pos == 128) { - interpolate_packed422_scanline (output, src1, src2, width); - } else { - const mmx_t all256 = { 0x0100010001000100ULL }; - const mmx_t round = { 0x0080008000800080ULL }; - - movd_m2r (pos, mm0); - pshufw_r2r (mm0, mm0, 0); - movq_m2r (all256, mm1); - psubw_r2r (mm0, mm1); - pxor_r2r (mm7, mm7); - - for (width /= 2; width; width--) { - movd_m2r (*src1, mm3); - movd_m2r (*src2, mm4); - punpcklbw_r2r (mm7, mm3); - punpcklbw_r2r (mm7, mm4); - - pmullw_r2r (mm1, mm3); - pmullw_r2r (mm0, mm4); - paddw_r2r (mm4, mm3); - paddw_m2r (round, mm3); - psrlw_i2r (8, mm3); - - packuswb_r2r (mm3, mm3); - movd_r2m (mm3, *output); - - output += 4; - src1 += 4; - src2 += 4; - } - sfence (); - emms (); - } -} -#endif - -#ifdef HAVE_CPU_I386 -static void -quarter_blit_vertical_packed422_scanline_mmxext (uint8_t * output, - uint8_t * one, uint8_t * three, int width) -{ - int i; - - for (i = width / 16; i; --i) { - movq_m2r (*one, mm0); - movq_m2r (*three, mm1); - movq_m2r (*(one + 8), mm2); - movq_m2r (*(three + 8), mm3); - movq_m2r (*(one + 16), mm4); - movq_m2r (*(three + 16), mm5); - movq_m2r (*(one + 24), mm6); - movq_m2r (*(three + 24), mm7); - pavgb_r2r (mm1, mm0); - pavgb_r2r (mm1, mm0); - pavgb_r2r (mm3, mm2); - pavgb_r2r (mm3, mm2); - pavgb_r2r (mm5, mm4); - pavgb_r2r (mm5, mm4); - pavgb_r2r (mm7, mm6); - pavgb_r2r (mm7, mm6); - movntq_r2m (mm0, *output); - movntq_r2m (mm2, *(output + 8)); - movntq_r2m (mm4, *(output + 16)); - movntq_r2m (mm6, *(output + 24)); - output += 32; - one += 32; - three += 32; - } - width = (width & 0xf); - - for (i = width / 4; i; --i) { - movq_m2r (*one, mm0); - movq_m2r (*three, mm1); - pavgb_r2r (mm1, mm0); - pavgb_r2r (mm1, mm0); - movntq_r2m (mm0, *output); - output += 8; - one += 8; - three += 8; - } - width = width & 0x7; - - /* Handle last few pixels. */ - for (i = width * 2; i; --i) { - *output++ = (*one + *three + *three + *three + 2) / 4; - one++; - three++; - } - - sfence (); - emms (); -} -#endif - - -static void -quarter_blit_vertical_packed422_scanline_c (uint8_t * output, uint8_t * one, - uint8_t * three, int width) -{ - width *= 2; - while (width--) { - *output++ = (*one + *three + *three + *three + 2) / 4; - one++; - three++; - } -} - -static void -subpix_blit_vertical_packed422_scanline_c (uint8_t * output, uint8_t * top, - uint8_t * bot, int subpixpos, int width) -{ - if (subpixpos == 32768) { - interpolate_packed422_scanline (output, top, bot, width); - } else if (subpixpos == 16384) { - quarter_blit_vertical_packed422_scanline (output, top, bot, width); - } else if (subpixpos == 49152) { - quarter_blit_vertical_packed422_scanline (output, bot, top, width); - } else { - int x; - - width *= 2; - for (x = 0; x < width; x++) { - output[x] = - ((top[x] * subpixpos) + (bot[x] * (0xffff - subpixpos))) >> 16; - } - } -} - -static void -a8_subpix_blit_scanline_c (uint8_t * output, uint8_t * input, - int lasta, int startpos, int width) -{ - int pos = 0xffff - (startpos & 0xffff); - - int prev = lasta; - - int x; - - for (x = 0; x < width; x++) { - output[x] = ((prev * pos) + (input[x] * (0xffff - pos))) >> 16; - prev = input[x]; - } -} - -/* - * These are from lavtools in mjpegtools: - * - * colorspace.c: Routines to perform colorspace conversions. - * - * Copyright (C) 2001 Matthew J. Marjanovic <maddog@mir.com> - * - * This program 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. - * - * This program 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 this program; if not, write to the Free Software - * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. - */ - -#define FP_BITS 18 - -/* precomputed tables */ - -static int Y_R[256]; - -static int Y_G[256]; - -static int Y_B[256]; - -static int Cb_R[256]; - -static int Cb_G[256]; - -static int Cb_B[256]; - -static int Cr_R[256]; - -static int Cr_G[256]; - -static int Cr_B[256]; - -static int conv_RY_inited = 0; - -static int RGB_Y[256]; - -static int R_Cr[256]; - -static int G_Cb[256]; - -static int G_Cr[256]; - -static int B_Cb[256]; - -static int conv_YR_inited = 0; - -static int -myround (double n) -{ - if (n >= 0) - return (int) (n + 0.5); - else - return (int) (n - 0.5); -} - -static void -init_RGB_to_YCbCr_tables (void) -{ - int i; - - /* - * Q_Z[i] = (coefficient * i - * * (Q-excursion) / (Z-excursion) * fixed-point-factor) - * - * to one of each, add the following: - * + (fixed-point-factor / 2) --- for rounding later - * + (Q-offset * fixed-point-factor) --- to add the offset - * - */ - for (i = 0; i < 256; i++) { - Y_R[i] = - myround (0.299 * (double) i * 219.0 / 255.0 * (double) (1 << FP_BITS)); - Y_G[i] = - myround (0.587 * (double) i * 219.0 / 255.0 * (double) (1 << FP_BITS)); - Y_B[i] = - myround ((0.114 * (double) i * 219.0 / 255.0 * (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1)) + (16.0 * (double) (1 << FP_BITS))); - - Cb_R[i] = - myround (-0.168736 * (double) i * 224.0 / 255.0 * - (double) (1 << FP_BITS)); - Cb_G[i] = - myround (-0.331264 * (double) i * 224.0 / 255.0 * - (double) (1 << FP_BITS)); - Cb_B[i] = - myround ((0.500 * (double) i * 224.0 / 255.0 * (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1)) + (128.0 * (double) (1 << FP_BITS))); - - Cr_R[i] = - myround (0.500 * (double) i * 224.0 / 255.0 * (double) (1 << FP_BITS)); - Cr_G[i] = - myround (-0.418688 * (double) i * 224.0 / 255.0 * - (double) (1 << FP_BITS)); - Cr_B[i] = - myround ((-0.081312 * (double) i * 224.0 / 255.0 * - (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1)) + (128.0 * (double) (1 << FP_BITS))); - } - conv_RY_inited = 1; -} - -static void -init_YCbCr_to_RGB_tables (void) -{ - int i; - - /* - * Q_Z[i] = (coefficient * i - * * (Q-excursion) / (Z-excursion) * fixed-point-factor) - * - * to one of each, add the following: - * + (fixed-point-factor / 2) --- for rounding later - * + (Q-offset * fixed-point-factor) --- to add the offset - * - */ - - /* clip Y values under 16 */ - for (i = 0; i < 16; i++) { - RGB_Y[i] = - myround ((1.0 * (double) (16) * 255.0 / 219.0 * (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1))); - } - for (i = 16; i < 236; i++) { - RGB_Y[i] = - myround ((1.0 * (double) (i - - 16) * 255.0 / 219.0 * (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1))); - } - /* clip Y values above 235 */ - for (i = 236; i < 256; i++) { - RGB_Y[i] = - myround ((1.0 * (double) (235) * 255.0 / 219.0 * - (double) (1 << FP_BITS)) - + (double) (1 << (FP_BITS - 1))); - } - - /* clip Cb/Cr values below 16 */ - for (i = 0; i < 16; i++) { - R_Cr[i] = - myround (1.402 * (double) (-112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - G_Cr[i] = - myround (-0.714136 * (double) (-112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - G_Cb[i] = - myround (-0.344136 * (double) (-112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - B_Cb[i] = - myround (1.772 * (double) (-112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - } - for (i = 16; i < 241; i++) { - R_Cr[i] = - myround (1.402 * (double) (i - - 128) * 255.0 / 224.0 * (double) (1 << FP_BITS)); - G_Cr[i] = - myround (-0.714136 * (double) (i - - 128) * 255.0 / 224.0 * (double) (1 << FP_BITS)); - G_Cb[i] = - myround (-0.344136 * (double) (i - - 128) * 255.0 / 224.0 * (double) (1 << FP_BITS)); - B_Cb[i] = - myround (1.772 * (double) (i - - 128) * 255.0 / 224.0 * (double) (1 << FP_BITS)); - } - /* clip Cb/Cr values above 240 */ - for (i = 241; i < 256; i++) { - R_Cr[i] = - myround (1.402 * (double) (112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - G_Cr[i] = - myround (-0.714136 * (double) (112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - G_Cb[i] = - myround (-0.344136 * (double) (i - - 128) * 255.0 / 224.0 * (double) (1 << FP_BITS)); - B_Cb[i] = - myround (1.772 * (double) (112) * 255.0 / 224.0 * - (double) (1 << FP_BITS)); - } - conv_YR_inited = 1; -} - -static void -rgb24_to_packed444_rec601_scanline_c (uint8_t * output, uint8_t * input, - int width) -{ - if (!conv_RY_inited) - init_RGB_to_YCbCr_tables (); - - while (width--) { - int r = input[0]; - - int g = input[1]; - - int b = input[2]; - - output[0] = (Y_R[r] + Y_G[g] + Y_B[b]) >> FP_BITS; - output[1] = (Cb_R[r] + Cb_G[g] + Cb_B[b]) >> FP_BITS; - output[2] = (Cr_R[r] + Cr_G[g] + Cr_B[b]) >> FP_BITS; - output += 3; - input += 3; - } -} - -static void -rgba32_to_packed4444_rec601_scanline_c (uint8_t * output, uint8_t * input, - int width) -{ - if (!conv_RY_inited) - init_RGB_to_YCbCr_tables (); - - while (width--) { - int r = input[0]; - - int g = input[1]; - - int b = input[2]; - - int a = input[3]; - - output[0] = a; - output[1] = (Y_R[r] + Y_G[g] + Y_B[b]) >> FP_BITS; - output[2] = (Cb_R[r] + Cb_G[g] + Cb_B[b]) >> FP_BITS; - output[3] = (Cr_R[r] + Cr_G[g] + Cr_B[b]) >> FP_BITS; - output += 4; - input += 4; - } -} - -static void -packed444_to_rgb24_rec601_scanline_c (uint8_t * output, uint8_t * input, - int width) -{ - if (!conv_YR_inited) - init_YCbCr_to_RGB_tables (); - - while (width--) { - int luma = input[0]; - - int cb = input[1]; - - int cr = input[2]; - - output[0] = clip255 ((RGB_Y[luma] + R_Cr[cr]) >> FP_BITS); - output[1] = clip255 ((RGB_Y[luma] + G_Cb[cb] + G_Cr[cr]) >> FP_BITS); - output[2] = clip255 ((RGB_Y[luma] + B_Cb[cb]) >> FP_BITS); - - output += 3; - input += 3; - } -} - -/* - * 601 numbers: - * - * Y' = 0.299*R' + 0.587*G' + 0.114*B' (in 0.0 to 1.0) - * Cb = -0.169*R' - 0.331*G' + 0.500*B' (in -0.5 to +0.5) - * Cr = 0.500*R' - 0.419*G' - 0.081*B' (in -0.5 to +0.5) - * - * Inverse: - * Y Cb Cr - * R 1.0000 -0.0009 1.4017 - * G 1.0000 -0.3437 -0.7142 - * B 1.0000 1.7722 0.0010 - * - * S170M numbers: - * Y' = 0.299*R' + 0.587*G' + 0.114*B' (in 0.0 to 1.0) - * B-Y' = -0.299*R' - 0.587*G' + 0.886*B' - * R-Y' = 0.701*R' - 0.587*G' - 0.114*B' - */ -/* -static void packed444_to_rgb24_rec601_reference_scanline( uint8_t *output, uint8_t *input, int width ) -{ - while( width-- ) { - double yp = (((double) input[ 0 ]) - 16.0) / 255.0; - double cb = (((double) input[ 1 ]) - 128.0) / 255.0; - double cr = (((double) input[ 2 ]) - 128.0) / 255.0; - double r, g, b; - - r = yp - (0.0009*cb) + (1.4017*cr); - g = yp - (0.3437*cb) - (0.7142*cr); - b = yp + (1.7722*cb) + (0.0010*cr); - - if( r > 1.0 ) r = 1.0; else if( r < 0.0 ) r = 0.0; - if( g > 1.0 ) g = 1.0; else if( g < 0.0 ) g = 0.0; - if( b > 1.0 ) b = 1.0; else if( b < 0.0 ) b = 0.0; - - output[ 0 ] = (int) ((r * 255.0) + 0.5); - output[ 1 ] = (int) ((g * 255.0) + 0.5); - output[ 2 ] = (int) ((b * 255.0) + 0.5); - - output += 3; - input += 3; - } -} -*/ - -static void -packed444_to_nonpremultiplied_packed4444_scanline_c (uint8_t * output, - uint8_t * input, int width, int alpha) -{ - int i; - - for (i = 0; i < width; i++) { - output[0] = alpha & 0xff; - output[1] = input[0] & 0xff; - output[2] = input[1] & 0xff; - output[3] = input[2] & 0xff; - - output += 4; - input += 3; - } -} - -static void -aspect_adjust_packed4444_scanline_c (uint8_t * output, - uint8_t * input, int width, double pixel_aspect) -{ - double i; - - int prev_i = 0; - - int w = 0; - - pixel_aspect = 1.0 / pixel_aspect; - - for (i = 0.0; i < width; i += pixel_aspect) { - uint8_t *curin = input + ((int) i) * 4; - - if (!prev_i) { - output[0] = curin[0]; - output[1] = curin[1]; - output[2] = curin[2]; - output[3] = curin[3]; - } else { - int avg_a = 0; - - int avg_y = 0; - - int avg_cb = 0; - - int avg_cr = 0; - - int pos = prev_i * 4; - - int c = 0; - - int j; - - for (j = prev_i; j <= (int) i; j++) { - avg_a += input[pos++]; - avg_y += input[pos++]; - avg_cb += input[pos++]; - avg_cr += input[pos++]; - c++; - } - output[0] = avg_a / c; - output[1] = avg_y / c; - output[2] = avg_cb / c; - output[3] = avg_cr / c; - } - output += 4; - prev_i = (int) i; - w++; - } -} - -static uint32_t speedy_accel; - -void -setup_speedy_calls (uint32_t accel, int verbose) -{ - speedy_accel = accel; - - interpolate_packed422_scanline = interpolate_packed422_scanline_c; - blit_colour_packed422_scanline = blit_colour_packed422_scanline_c; - blit_colour_packed4444_scanline = blit_colour_packed4444_scanline_c; - blit_packed422_scanline = blit_packed422_scanline_c; - composite_packed4444_to_packed422_scanline = - composite_packed4444_to_packed422_scanline_c; - composite_packed4444_alpha_to_packed422_scanline = - composite_packed4444_alpha_to_packed422_scanline_c; - composite_alphamask_to_packed4444_scanline = - composite_alphamask_to_packed4444_scanline_c; - composite_alphamask_alpha_to_packed4444_scanline = - composite_alphamask_alpha_to_packed4444_scanline_c; - premultiply_packed4444_scanline = premultiply_packed4444_scanline_c; - blend_packed422_scanline = blend_packed422_scanline_c; - comb_factor_packed422_scanline = 0; - diff_factor_packed422_scanline = diff_factor_packed422_scanline_c; - kill_chroma_packed422_inplace_scanline = - kill_chroma_packed422_inplace_scanline_c; - mirror_packed422_inplace_scanline = mirror_packed422_inplace_scanline_c; - speedy_memcpy = speedy_memcpy_c; - diff_packed422_block8x8 = diff_packed422_block8x8_c; - a8_subpix_blit_scanline = a8_subpix_blit_scanline_c; - quarter_blit_vertical_packed422_scanline = - quarter_blit_vertical_packed422_scanline_c; - subpix_blit_vertical_packed422_scanline = - subpix_blit_vertical_packed422_scanline_c; - packed444_to_nonpremultiplied_packed4444_scanline = - packed444_to_nonpremultiplied_packed4444_scanline_c; - aspect_adjust_packed4444_scanline = aspect_adjust_packed4444_scanline_c; - packed444_to_packed422_scanline = packed444_to_packed422_scanline_c; - packed422_to_packed444_scanline = packed422_to_packed444_scanline_c; - packed422_to_packed444_rec601_scanline = - packed422_to_packed444_rec601_scanline_c; - packed444_to_rgb24_rec601_scanline = packed444_to_rgb24_rec601_scanline_c; - rgb24_to_packed444_rec601_scanline = rgb24_to_packed444_rec601_scanline_c; - rgba32_to_packed4444_rec601_scanline = rgba32_to_packed4444_rec601_scanline_c; - invert_colour_packed422_inplace_scanline = - invert_colour_packed422_inplace_scanline_c; - vfilter_chroma_121_packed422_scanline = - vfilter_chroma_121_packed422_scanline_c; - vfilter_chroma_332_packed422_scanline = - vfilter_chroma_332_packed422_scanline_c; - convert_uyvy_to_yuyv_scanline = convert_uyvy_to_yuyv_scanline_c; - composite_colour4444_alpha_to_packed422_scanline = - composite_colour4444_alpha_to_packed422_scanline_c; - -#ifdef HAVE_CPU_I386 - if (speedy_accel & OIL_IMPL_FLAG_MMXEXT) { - if (verbose) { - fprintf (stderr, "speedycode: Using MMXEXT optimized functions.\n"); - } - interpolate_packed422_scanline = interpolate_packed422_scanline_mmxext; - blit_colour_packed422_scanline = blit_colour_packed422_scanline_mmxext; - blit_colour_packed4444_scanline = blit_colour_packed4444_scanline_mmxext; - blit_packed422_scanline = blit_packed422_scanline_mmxext; - composite_packed4444_to_packed422_scanline = - composite_packed4444_to_packed422_scanline_mmxext; - composite_packed4444_alpha_to_packed422_scanline = - composite_packed4444_alpha_to_packed422_scanline_mmxext; - composite_alphamask_to_packed4444_scanline = - composite_alphamask_to_packed4444_scanline_mmxext; - premultiply_packed4444_scanline = premultiply_packed4444_scanline_mmxext; - kill_chroma_packed422_inplace_scanline = - kill_chroma_packed422_inplace_scanline_mmx; - blend_packed422_scanline = blend_packed422_scanline_mmxext; - diff_factor_packed422_scanline = diff_factor_packed422_scanline_mmx; - comb_factor_packed422_scanline = comb_factor_packed422_scanline_mmx; - diff_packed422_block8x8 = diff_packed422_block8x8_mmx; - quarter_blit_vertical_packed422_scanline = - quarter_blit_vertical_packed422_scanline_mmxext; - invert_colour_packed422_inplace_scanline = - invert_colour_packed422_inplace_scanline_mmx; - vfilter_chroma_121_packed422_scanline = - vfilter_chroma_121_packed422_scanline_mmx; - vfilter_chroma_332_packed422_scanline = - vfilter_chroma_332_packed422_scanline_mmx; - convert_uyvy_to_yuyv_scanline = convert_uyvy_to_yuyv_scanline_mmx; - composite_colour4444_alpha_to_packed422_scanline = - composite_colour4444_alpha_to_packed422_scanline_mmxext; - speedy_memcpy = speedy_memcpy_mmxext; - } else if (speedy_accel & OIL_IMPL_FLAG_MMX) { - if (verbose) { - fprintf (stderr, "speedycode: Using MMX optimized functions.\n"); - } - interpolate_packed422_scanline = interpolate_packed422_scanline_mmx; - blit_colour_packed422_scanline = blit_colour_packed422_scanline_mmx; - blit_colour_packed4444_scanline = blit_colour_packed4444_scanline_mmx; - blit_packed422_scanline = blit_packed422_scanline_mmx; - diff_factor_packed422_scanline = diff_factor_packed422_scanline_mmx; - comb_factor_packed422_scanline = comb_factor_packed422_scanline_mmx; - kill_chroma_packed422_inplace_scanline = - kill_chroma_packed422_inplace_scanline_mmx; - diff_packed422_block8x8 = diff_packed422_block8x8_mmx; - invert_colour_packed422_inplace_scanline = - invert_colour_packed422_inplace_scanline_mmx; - vfilter_chroma_121_packed422_scanline = - vfilter_chroma_121_packed422_scanline_mmx; - vfilter_chroma_332_packed422_scanline = - vfilter_chroma_332_packed422_scanline_mmx; - convert_uyvy_to_yuyv_scanline = convert_uyvy_to_yuyv_scanline_mmx; - speedy_memcpy = speedy_memcpy_mmx; - } else { - if (verbose) { - fprintf (stderr, - "speedycode: No MMX or MMXEXT support detected, using C fallbacks.\n"); - } - } -#endif -} - -uint32_t -speedy_get_accel (void) -{ - return speedy_accel; -} |