rgb444torgb444.c

linux下的一款播放器

/* ***** BEGIN LICENSE BLOCK *****
 * Source last modified: $Id: rgb444torgb444.c,v 1.2.8.1 2004/07/09 02:00:07 hubbe Exp $
 * 
 * Portions Copyright (c) 1995-2004 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 (the "RPSL") available at
 * http://www.helixcommunity.org/content/rpsl unless you have licensed
 * the file under the current version of the RealNetworks Community
 * Source License (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.
 * 
 * Alternatively, the contents of this file may be used under the
 * terms of the GNU General Public License Version 2 or later (the
 * "GPL") in which case the provisions of the GPL are applicable
 * instead of those above. If you wish to allow use of your version of
 * this file only under the terms of the GPL, and not to allow others
 * to use your version of this file under the terms of either the RPSL
 * or RCSL, indicate your decision by deleting the provisions above
 * and replace them with the notice and other provisions required by
 * the GPL. If you do not delete the provisions above, a recipient may
 * use your version of this file under the terms of any one of the
 * RPSL, the RCSL or the GPL.
 * 
 * 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 "hlxclib/string.h"
#include "nostatic/colorlib.h"
#include "nostatic/rgb.h"
#include "nostatic/rgbcommon.h"

void
RGB444toRGB444_ROW_SHRINK (unsigned char *dest_ptr,
                          int dest_dx, unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d = dest_ptr;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    register int limit = src_dx >> 1;
    register int step = dest_dx;
    if (count)
    {
        do 
        {
            register unsigned int da_rgb; 
            register unsigned int sa_rgb;   
            sa_rgb = *(unsigned short *) (s); 
            da_rgb = sa_rgb;
            *(unsigned short *) (d) = da_rgb;
            d += 2;
            do
            {
                s += 2;
            } while ((limit -= step) >= 0);
            limit += src_dx;
        } while (--count);
    }
}


void
RGB444toRGB444_ROW_COPY (unsigned char *dest_ptr, int dest_dx,
                        unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d = dest_ptr;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    while (((unsigned int) d & 3) && ((unsigned int) s & 3) && count)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        *(unsigned short *) (d) = da_rgb;
        d += 2;
        count--;
    }
    while (count >= 4)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        *(unsigned short *) (d) = da_rgb;

        sa_rgb = *(unsigned short *) (s + 2);
        da_rgb = sa_rgb;
        *(unsigned short *) (d + 2) = da_rgb;

        sa_rgb = *(unsigned short *) (s + 4);
        da_rgb = sa_rgb;
        *(unsigned short *) (d + 2 * 2) = da_rgb;

        sa_rgb = *(unsigned short *) (s + 6);
        da_rgb = sa_rgb;
        *(unsigned short *) (d + 3 * 2) = da_rgb;

        s += 8;
        d += 4 * 2;
        count -= 4;
    }

    while (count)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        *(unsigned short *) (d) = da_rgb;
        d += 2;
        count--;
    }
}


void
RGB444toRGB444_ROW_STRETCH (unsigned char *dest_ptr, int dest_dx,
                           unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d = dest_ptr;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    register int limit = dest_dx >> 1;
    register int step = src_dx;
    if (count)
    {
        goto start;
        do
        {
            register unsigned int da_rgb;
            if ((limit -= step) < 0)
            {
                limit += dest_dx;
              start:
                register unsigned int sa_rgb;
                sa_rgb = *(unsigned short *) (s);
                da_rgb = sa_rgb;
                s += 2;
            }
            *(unsigned short *) (d) = da_rgb;
            d += 2;
        }
        while (--count);
    }
}


void
RGB444toRGB444_ROW_STRETCH2X (unsigned char *dest_ptr, int dest_dx,
                             unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d = dest_ptr;
    register unsigned char *s = src_ptr;
    register int count = src_dx;
    if (count)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        count--;
        *(unsigned short *) (d) = da_rgb;
        d += 2;
        while (count >= 2)
        {
            register unsigned int db_rgb;
            register unsigned int sa_rgb;
            sa_rgb = *(unsigned short *) (s);
            db_rgb = sa_rgb;
            da_rgb =(((da_rgb ^ db_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & db_rgb);
            *(unsigned short *) (d) = da_rgb;
            *(unsigned short *) (d + 2) = db_rgb;
            sa_rgb = *(unsigned short *) (s + 2);
            da_rgb = sa_rgb;
            db_rgb =(((db_rgb ^ da_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (db_rgb & da_rgb);
            *(unsigned short *) (d + 2 * 2) = db_rgb;
            *(unsigned short *) (d + 3 * 2) = da_rgb;
            s += 4;
            d += 4 * 2;
            count -= 2;
        }
        if (count)
        {
            register unsigned int db_rgb;
            register unsigned int sa_rgb;
            sa_rgb = *(unsigned short *) (s);
            db_rgb = sa_rgb;
            da_rgb =(((da_rgb ^ db_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & db_rgb);
            *(unsigned short *) (d) = da_rgb;
            *(unsigned short *) (d + 2) = db_rgb;
            *(unsigned short *) (d + 2 * 2) = db_rgb;
        }
        else
        {
            *(unsigned short *) (d) = da_rgb;
        }
    }
}


void
RGB444toRGB444_ROW_STRETCH2XPLUS (unsigned char *dest_ptr, int dest_dx,
                                 unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d = dest_ptr;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    register int limit = dest_dx >> 1;
    register int step = src_dx << 1;
    register int remainder = (2 * dest_dx - limit) / step;
    if (count)
    {
        register unsigned int da_rgb;
        register unsigned int db_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        if (!(count -= remainder))
            goto end_of_row;
        while (1)
        {
            do
            {
                *(unsigned short *) (d) = da_rgb;
                d += 2;
                if (!(--count))
                    goto end_of_row;
            }
            while ((limit -= step) >= 0);
            limit += dest_dx;
            register unsigned int sa_rgb;
            sa_rgb = *(unsigned short *) (s);
            db_rgb = sa_rgb;
            da_rgb =(((da_rgb ^ db_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & db_rgb);
            do
            {
                *(unsigned short *) (d) = da_rgb;
                d += 2;
                if (!(--count))
                    goto end_of_row;
            }
            while ((limit -= step) >= 0);
            limit += dest_dx;
            do
            {
                *(unsigned short *) (d) = db_rgb;
                d += 2;
                if (!(--count))
                    goto end_of_row_2;
            }
            while ((limit -= step) >= 0);
            limit += dest_dx;
            sa_rgb = *(unsigned short *) (s + 2);
            da_rgb = sa_rgb;
            s += 4;
            db_rgb =(((db_rgb ^ da_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (db_rgb & da_rgb);
            do
            {
                *(unsigned short *) (d) = db_rgb;
                d += 2;
                if (!(--count))
                    goto end_of_row_2;
            } while ((limit -= step) >= 0);
            limit += dest_dx;
        }
      end_of_row_2:
        da_rgb = db_rgb;
      end_of_row:
        while (remainder--)
        {
            *(unsigned short *) (d) = da_rgb;
            d += 2;
        }
    }
}





void
RGB444toRGB444_ROW2X_SHRINK (unsigned char *dest_ptr_1,
                            unsigned char *dest_ptr_12,
                            unsigned char *dest_ptr_2, int dest_dx,
                            unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d1 = dest_ptr_1;
    register unsigned char *d12 = dest_ptr_12;
    register unsigned char *d2 = dest_ptr_2;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    register int limit = src_dx >> 1;
    register int step = dest_dx;
    if (count)
    {
        do
        {
            register unsigned int da_rgb;
            register unsigned int sa_rgb;
            sa_rgb = *(unsigned short *) (s);
            da_rgb = sa_rgb;
            *(unsigned short *) (d2) = da_rgb;
            d2 += 2;
            register unsigned int sb_rgb;
            sb_rgb = *(unsigned short *) (d1);
            da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U <<0)))) +(da_rgb & sb_rgb);
            d1 += 2;
            *(unsigned short *) (d12) = da_rgb;
            d12 += 2;
            do
            {
                s += 2;
            }
            while ((limit -= step) >= 0);
            limit += src_dx;
        }
        while (--count);
    }
}



void
RGB444toRGB444_ROW2X_COPY (unsigned char *dest_ptr_1,
                          unsigned char *dest_ptr_12,
                          unsigned char *dest_ptr_2, int dest_dx,
                          unsigned char *src_ptr, int src_dx)
{
    register unsigned char *d1 = dest_ptr_1;
    register unsigned char *d12 = dest_ptr_12;
    register unsigned char *d2 = dest_ptr_2;
    register unsigned char *s = src_ptr;
    register int count = dest_dx;
    while (((unsigned int) d2 & 3) && ((unsigned int) s & 3) && count)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        *(unsigned short *) (d2) = da_rgb;
        d2 += 2;
        register unsigned int sb_rgb;
        sb_rgb = *(unsigned short *) (d1);
        da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & sb_rgb);
        d1 += 2;
        *(unsigned short *) (d12) = da_rgb;
        d12 += 2;
        count--;
    }
    while (count >= 4)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        register unsigned int sb_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        *(unsigned short *) (d2) = da_rgb;
        sb_rgb = *(unsigned short *) (d1);
        da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & sb_rgb);
        *(unsigned short *) (d12) = da_rgb;
        sa_rgb = *(unsigned short *) (s + 2);
        da_rgb = sa_rgb;
        *(unsigned short *) (d2 + 2) = da_rgb;
        sb_rgb = *(unsigned short *) (d1 + 2);
        da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & sb_rgb);
        *(unsigned short *) (d12 + 2) = da_rgb;
        sa_rgb = *(unsigned short *) (s + 4);
        da_rgb = sa_rgb;
        *(unsigned short *) (d2 + 2 * 2) = da_rgb;
        sb_rgb = *(unsigned short *) (d1 + 2 * 2);
        da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & sb_rgb);
        *(unsigned short *) (d12 + 2 * 2) = da_rgb;
        sa_rgb = *(unsigned short *) (s + 6);
        da_rgb = sa_rgb;
        *(unsigned short *) (d2 + 3 * 2) = da_rgb;
        sb_rgb = *(unsigned short *) (d1 + 3 * 2);
        da_rgb =(((da_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (da_rgb & sb_rgb);
        *(unsigned short *) (d12 + 3 * 2) = da_rgb;
        s += 8;
        d1 += 4 * 2;
        d2 += 4 * 2;
        d12 += 4 * 2;
        count -= 4;
    }
    while (count)
    {
        register unsigned int da_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        *(unsigned short *) (d2) = da_rgb;
        d2 += 2;
        register unsigned int sb_rgb;