444v565.c

著名的 helix realplayer 基于手机 symbian 系统的 播放器全套源代码

/* ***** BEGIN LICENSE BLOCK ***** 
 * Version: RCSL 1.0/RPSL 1.0 
 *  
 * Portions Copyright (c) 1995-2002 RealNetworks, Inc. All Rights Reserved. 
 *      
 * The contents of this file, and the files included with this file, are 
 * subject to the current version of the RealNetworks Public Source License 
 * Version 1.0 (the "RPSL") available at 
 * http://www.helixcommunity.org/content/rpsl unless you have licensed 
 * the file under the RealNetworks Community Source License Version 1.0 
 * (the "RCSL") available at http://www.helixcommunity.org/content/rcsl, 
 * in which case the RCSL will apply. You may also obtain the license terms 
 * directly from RealNetworks.  You may not use this file except in 
 * compliance with the RPSL or, if you have a valid RCSL with RealNetworks 
 * applicable to this file, the RCSL.  Please see the applicable RPSL or 
 * RCSL for the rights, obligations and limitations governing use of the 
 * contents of the file.  
 *  
 * This file is part of the Helix DNA Technology. RealNetworks is the 
 * developer of the Original Code and owns the copyrights in the portions 
 * it created. 
 *  
 * This file, and the files included with this file, is distributed and made 
 * available on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER 
 * EXPRESS OR IMPLIED, AND REALNETWORKS HEREBY DISCLAIMS ALL SUCH WARRANTIES, 
 * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY, FITNESS 
 * FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT. 
 * 
 * Technology Compatibility Kit Test Suite(s) Location: 
 *    http://www.helixcommunity.org/content/tck 
 * 
 * Contributor(s): 
 *  
 * ***** END LICENSE BLOCK ***** */ 

#include <stdlib.h>
#include "nostatic/colorlib.h"
#include "nostatic/yuv.h"

/*
 * Format-conversion routines.
 * Use:
 *  int XXXXtoYYYYEx (unsigned char *dest_ptr, int dest_width, int dest_height,
 *      int dest_pitch, int dest_x, int dest_y, int dest_dx, int dest_dy,
 *      unsigned char *src_ptr, int src_width, int src_height, int src_pitch,
 *      int src_x, int src_y, int src_dx, int src_dy);
 * Input:
 *  dest_ptr - pointer to a destination buffer
 *  dest_width, dest_height - width/height of the destination image (pixels)
 *  dest_pitch - pitch of the dest. buffer (in bytes; <0 - if bottom up image)
 *  dest_x, dest_y, dest_dx, dest_dy - destination rectangle (pixels)
 *  src_ptr - pointer to an input image
 *  src_width, src_height - width/height of the input image (pixels)
 *  src_pitch - pitch of the source buffer (in bytes; <0 - if bottom up image)
 *  src_x, src_y, src_dx, src_dy - source rectangle (pixels)
 * Returns:
 *  0 - if success; -1 if failure.
 * Notes:
 *  a) In all cases, pointers to the source and destination buffers must be
 *     DWORD aligned, and both pitch parameters must be multiple of 4!!!
 *  b) Converters that deal with YUV 4:2:2, or 4:2:0 formats may also require
 *     rectangle parameters (x,y,dx,dy) to be multiple of 2. Failure to provide
 *     aligned rectangles will result in partially converted image.
 *  c) Currently only scale factors of 1:1 and 2:1 are supported; if the rates
 *     dest_dx/src_dx & dest_dy/src_dy are neither 1, or 2, the converters
 *     will fail.
 */

#define BYTESPERPIXEL 2

/* Indexing tables */
static const int next[3] = {1, 2, 0};                 /* (ibuf+1)%3 table */
static const int next2[3] = {2, 0, 1};                /* (ibuf+2)%3 table */

/* Half resolution converter.  */
static void halfI420toRGB444v565 (unsigned char *d1,
				int dest_x, unsigned char *sy1, 
				unsigned char *sy2, unsigned char *su, 
				unsigned char *sv, int src_x, int dx, int isodd,
				  color_data_t* pcd)
{
  /* check if we have misaligned input/output: */
  if ((src_x ^ dest_x) & 1) {
    
    ; /* not implemented yet */
    
  } else {
    
    /* aligned input/output: */
    register int y11, y12;
    register int rv1, guv1, bu1, rv2, guv2, bu2;
    register int i;
    
    /* source width should always be multiples of 4 */
    /*    assert((src_x & 3)==0); */

    /* convert all integral 2x4 blocks: */
    if (isodd)
      for (i = 0; i < dx/4; i ++) {
	
	/* first 2x2 block */
	rv1 = pcd->rvtab[sv[0]];
	guv1 = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
	bu1 = pcd->butab[su[0]];
	y11 = (pcd->ytab[sy1[0]] + pcd->ytab[sy1[1]] + pcd->ytab[sy2[0]] + pcd->ytab[sy2[1]])>>2; /* avg */
	
	/* second 2x2 block */
	rv2  = pcd->rvtab[sv[1]];
	guv2 = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
	bu2  = pcd->butab[su[1]];
	y12 = (pcd->ytab[sy1[2]] + pcd->ytab[sy1[3]] + pcd->ytab[sy2[2]] + pcd->ytab[sy2[3]])>>2;
	
	/* output 4 bytes at a time */
	*(unsigned int *)(d1+0) =
	  (CLIP4[y11 + bu1  + DITH4L] << 1)  |
	  (CLIP4[y11 + guv1 + DITH4L] << 7)  |
	  (CLIP4[y11 + rv1  + DITH4L] << 12) |
	  (CLIP4[y12 + bu2  + DITH4H] << 17) |
	  (CLIP4[y12 + guv2 + DITH4H] << 23) |
	  (CLIP4[y12 + rv2  + DITH4H] << 28) ;
	
	/* next 4x2 block */
	sy1 += 4; sy2 += 4;
	su += 2; sv += 2;
	d1 += 2*BPP2;
      }
    else
      for (i = 0; i < dx/4; i ++) {
	
	/* first 2x2 block */
	rv1 = pcd->rvtab[sv[0]];
	guv1 = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
	bu1 = pcd->butab[su[0]];
	y11 = (pcd->ytab[sy1[0]] + pcd->ytab[sy1[1]] + pcd->ytab[sy2[0]] + pcd->ytab[sy2[1]])>>2; /* avg */
	
	/* second 2x2 block */
	rv2  = pcd->rvtab[sv[1]];
	guv2 = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
	bu2  = pcd->butab[su[1]];
	y12 = (pcd->ytab[sy1[2]] + pcd->ytab[sy1[3]] + pcd->ytab[sy2[2]] + pcd->ytab[sy2[3]])>>2;
	
	/* output 4 bytes at a time */
	*(unsigned int *)(d1+0) =
	  (CLIP4[y11 + bu1  + DITH4H] << 1)  |
	  (CLIP4[y11 + guv1 + DITH4H] << 7)  |
	  (CLIP4[y11 + rv1  + DITH4H] << 12) |
	  (CLIP4[y12 + bu2  + DITH4L] << 17) |
	  (CLIP4[y12 + guv2 + DITH4L] << 23) |
	  (CLIP4[y12 + rv2  + DITH4L] << 28) ;
	
	/* next 4x2 block */
	sy1 += 4; sy2 += 4;
	su += 2; sv += 2;
	d1 += 2*BPP2;
      }

  }
}

static void dblineI420toRGB444v565 (unsigned char *d1, unsigned char *d2, 
				int dest_x, unsigned char *sy1, 
				unsigned char *sy2, unsigned char *su, 
				unsigned char *sv, int src_x, int dx,
				    color_data_t* pcd)
{
    /* check if we have misaligned input/output: */
    if ((src_x ^ dest_x) & 1) {

        ; /* not implemented yet */

    } else {

        /* aligned input/output: */
        register int y11, y12, y21, y22;
        register int rv, guv, bu;
        register int i;

        /* convert first 2x1 block: */
        if (dest_x & 1) {

            rv  = pcd->rvtab[sv[0]];
            guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
            bu  = pcd->butab[su[0]];
            y11 = pcd->ytab[sy1[0]];
            y21 = pcd->ytab[sy2[0]];

            /* output 2 bytes at a time */
            *(unsigned short *)(d1+0) =
                (CLIP4[y11 + bu  + DITH4L] << 1)  |
                (CLIP4[y11 + guv + DITH4L] << 7)  |
                (CLIP4[y11 + rv  + DITH4L] << 12) ;

            *(unsigned short *)(d2+0) =
                (CLIP4[y21 + bu  + DITH4H] << 1)  |
                (CLIP4[y21 + guv + DITH4H] << 7)  |
                (CLIP4[y21 + rv  + DITH4H] << 12) ;

            sy1 += 1; sy2 += 1;
            su += 1; sv += 1;
            d1 += BPP2; d2 += BPP2;
            dest_x ++; dx --;
        }

        /* convert first 2x2 block: */
        if (dest_x & 2) {

            rv  = pcd->rvtab[sv[0]];
            guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
            bu  = pcd->butab[su[0]];
            y11 = pcd->ytab[sy1[0]];
            y12 = pcd->ytab[sy1[1]];

            /* output 4 bytes at a time */
            *(unsigned int *)(d1+0) =
                (CLIP4[y11 + bu  + DITH4L] << 1)  |
                (CLIP4[y11 + guv + DITH4L] << 7)  |
                (CLIP4[y11 + rv  + DITH4L] << 12) |
                (CLIP4[y12 + bu  + DITH4H] << 17) |
                (CLIP4[y12 + guv + DITH4H] << 23) |
                (CLIP4[y12 + rv  + DITH4H] << 28) ;

            y21 = pcd->ytab[sy2[0]];
            y22 = pcd->ytab[sy2[1]];

            *(unsigned int *)(d2+0) =
                (CLIP4[y21 + bu  + DITH4H] << 1)  |
                (CLIP4[y21 + guv + DITH4H] << 7)  |
                (CLIP4[y21 + rv  + DITH4H] << 12) |
                (CLIP4[y22 + bu  + DITH4L] << 17) |
                (CLIP4[y22 + guv + DITH4L] << 23) |
                (CLIP4[y22 + rv  + DITH4L] << 28) ;

            sy1 += 2; sy2 += 2;
            su += 1; sv += 1;
            d1 += 2*BPP2; d2 += 2*BPP2;
            dest_x += 2; dx -= 2;
        }

        /* convert all integral 2x4 blocks: */
        for (i = 0; i < dx/4; i ++) {

            /* first 2x2 block */
            rv = pcd->rvtab[sv[0]];
            guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
            bu = pcd->butab[su[0]];
            y11 = pcd->ytab[sy1[0]];
            y12 = pcd->ytab[sy1[1]];

            /* output 4 bytes at a time */
            *(unsigned int *)(d1+0) =
                (CLIP4[y11 + bu  + DITH4L] << 1)  |
                (CLIP4[y11 + guv + DITH4L] << 7)  |
                (CLIP4[y11 + rv  + DITH4L] << 12) |
                (CLIP4[y12 + bu  + DITH4H] << 17) |
                (CLIP4[y12 + guv + DITH4H] << 23) |
                (CLIP4[y12 + rv  + DITH4H] << 28) ;

            y21 = pcd->ytab[sy2[0]];
            y22 = pcd->ytab[sy2[1]];

            *(unsigned int *)(d2+0) =
                (CLIP4[y21 + bu  + DITH4H] << 1)  |
                (CLIP4[y21 + guv + DITH4H] << 7)  |
                (CLIP4[y21 + rv  + DITH4H] << 12) |
                (CLIP4[y22 + bu  + DITH4L] << 17) |
                (CLIP4[y22 + guv + DITH4L] << 23) |
                (CLIP4[y22 + rv  + DITH4L] << 28) ;

            /* second 2x2 block */
            rv  = pcd->rvtab[sv[1]];
            guv = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
            bu  = pcd->butab[su[1]];
            y11 = pcd->ytab[sy1[2]];
            y12 = pcd->ytab[sy1[3]];

            *(unsigned int *)(d1+2*BPP2) =
                (CLIP4[y11 + bu  + DITH4L] << 1)  |
                (CLIP4[y11 + guv + DITH4L] << 7)  |
                (CLIP4[y11 + rv  + DITH4L] << 12) |
                (CLIP4[y12 + bu  + DITH4H] << 17) |
                (CLIP4[y12 + guv + DITH4H] << 23) |
                (CLIP4[y12 + rv  + DITH4H] << 28) ;

            y21 = pcd->ytab[sy2[2]];
            y22 = pcd->ytab[sy2[3]];

            *(unsigned int *)(d2+2*BPP2) =
                (CLIP4[y21 + bu  + DITH4H] << 1)  |
                (CLIP4[y21 + guv + DITH4H] << 7)  |
                (CLIP4[y21 + rv  + DITH4H] << 12) |
                (CLIP4[y22 + bu  + DITH4L] << 17) |
                (CLIP4[y22 + guv + DITH4L] << 23) |
                (CLIP4[y22 + rv  + DITH4L] << 28) ;

            /* next 4x2 block */
            sy1 += 4; sy2 += 4;
            su += 2; sv += 2;
            d1 += 4*BPP2; d2 += 4*BPP2;
        }

        /* convert last 2x2 block: */
        if (dx & 2) {

            rv = pcd->rvtab[sv[0]];
            guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
            bu = pcd->butab[su[0]];
            y11 = pcd->ytab[sy1[0]];
            y12 = pcd->ytab[sy1[1]];

            /* output 4 bytes at a time */
            *(unsigned int *)(d1+0) =
                (CLIP4[y11 + bu  + DITH4L] << 1)  |