rgb444torgb444.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 "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;
        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--;
    }