rgb444torgb444.c

linux下的一款播放器

        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--;
    }
}



void
RGB444toRGB444_ROW2X_STRETCH (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 = dest_dx >> 1;
    register int step = src_dx;
    if (count)
    {
        goto start;
        do
        {
            register unsigned int da_rgb;
            register unsigned int dc_rgb;
            if ((limit -= step) < 0)
            {
                limit += dest_dx;
              start:if (5 == 0)
              {
                  da_rgb = *(unsigned short *) (s);
              }
              else
              {
                  register unsigned int sa_rgb;
                  sa_rgb = *(unsigned short *) (s);
                  da_rgb = sa_rgb;
              }
                s += 2;
                register unsigned int sb_rgb;
                sb_rgb = *(unsigned short *) (d1);
                dc_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 *) (d2) = da_rgb;
            d2 += 2;
            *(unsigned short *) (d12) = dc_rgb;
            d12 += 2;
        }
        while (--count);
    }
}


void
RGB444toRGB444_ROW2X_STRETCH2X (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 = src_dx;
    if (count)
    {
        register unsigned int da_rgb;
        register unsigned int dc_rgb;
        register unsigned int sa_rgb;
        sa_rgb = *(unsigned short *) (s);
        da_rgb = sa_rgb;
        s += 2;
        register unsigned int sb_rgb;
        sb_rgb = *(unsigned short *) (d1);
        dc_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 * 2;
        count--;
        *(unsigned short *) (d2) = da_rgb;
        d2 += 2;
        *(unsigned short *) (d12) = dc_rgb;
        d12 += 2;
        while (count >= 2)
        {
            register unsigned int db_rgb;
            register unsigned int dd_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 *) (d2) = da_rgb;
            *(unsigned short *) (d2 + 2) = db_rgb;
            register unsigned int sb_rgb;
            sb_rgb = *(unsigned short *) (d1);
            dd_rgb =(((db_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U <<0)))) +(db_rgb & sb_rgb);
            dc_rgb =(((dc_rgb ^ dd_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (dc_rgb & dd_rgb);
            *(unsigned short *) (d12) = dc_rgb;
            *(unsigned short *) (d12 + 2) = dd_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 *) (d2 + 2 * 2) = db_rgb;
            *(unsigned short *) (d2 + 3 * 2) = da_rgb;
            sb_rgb = *(unsigned short *) (d1 + 2 * 2);
            dc_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);
            dd_rgb =(((dd_rgb ^ dc_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (dd_rgb & dc_rgb);
            *(unsigned short *) (d12 + 2 * 2) = dd_rgb;
            *(unsigned short *) (d12 + 3 * 2) = dc_rgb;
            s += 4;
            d1 += 4 * 2;
            d2 += 4 * 2;
            d12 += 4 * 2;
            count -= 2;
        }
        if (count)
        {
            register unsigned int db_rgb;
            register unsigned int dd_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 *) (d2) = da_rgb;
            *(unsigned short *) (d2 + 2) = db_rgb;
            *(unsigned short *) (d2 + 2 * 2) = db_rgb;
            register unsigned int sb_rgb;
            sb_rgb = *(unsigned short *) (d1);
            dd_rgb =(((db_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U <<0)))) +(db_rgb & sb_rgb);
            dc_rgb =(((dc_rgb ^ dd_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (dc_rgb & dd_rgb);
            *(unsigned short *) (d12) = dc_rgb;
            *(unsigned short *) (d12 + 2) = dd_rgb;
            *(unsigned short *) (d12 + 2 * 2) = dd_rgb;
        }
        else
        {
            *(unsigned short *) (d2) = da_rgb;
            *(unsigned short *) (d12) = dc_rgb;
        }
    }
}



void
RGB444toRGB444_ROW2X_STRETCH2XPLUS (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 = 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 dc_rgb;
        register unsigned int dd_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)
        {
            register unsigned int sb_rgb;
            sb_rgb = *(unsigned short *) (d1);
            dc_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);
            do
            {
                d1 += 2;
                *(unsigned short *) (d2) = da_rgb;
                d2 += 2;
                *(unsigned short *) (d12) = dc_rgb;
                d12 += 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);
            sb_rgb = *(unsigned short *) (d1);
            dc_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);
            do
            {
                d1 += 2;
                *(unsigned short *) (d2) = da_rgb;
                d2 += 2;
                *(unsigned short *) (d12) = dc_rgb;
                d12 += 2;
                if (!(--count))
                    goto end_of_row;
            }
            while ((limit -= step) >= 0);
            limit += dest_dx;
            sb_rgb = *(unsigned short *) (d1);
            dd_rgb =(((db_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (db_rgb & sb_rgb);
            do
            {
                d1 += 2;
                *(unsigned short *) (d2) = db_rgb;
                d2 += 2;
                *(unsigned short *) (d12) = dd_rgb;
                d12 += 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);
            sb_rgb = *(unsigned short *) (d1);
            dd_rgb =(((db_rgb ^ sb_rgb) >> 1) &(((1U << (8 + 4 - 1)) - (1U << 8)) | ((1U << (4 + 4 - 1)) -(1U << 4)) | ((1U <<(0 + 4 -1)) -(1U << 0))))+ (db_rgb & sb_rgb);
            do
            {
                d1 += 2;
                *(unsigned short *) (d2) = db_rgb;
                d2 += 2;
                *(unsigned short *) (d12) = dd_rgb;
                d12 += 2;
                if (!(--count))
                    goto end_of_row_2;
            }
            while ((limit -= step) >= 0);
            limit += dest_dx;
        }
      end_of_row_2:
        da_rgb = db_rgb;
        dc_rgb = dd_rgb;
      end_of_row:
        while (remainder--)
        {
            *(unsigned short *) (d2) = da_rgb;
            d2 += 2;
            *(unsigned short *) (d12) = dc_rgb;
            d12 += 2;
        }
    }
}


int
RGBtoRGB4 (int dest_format, 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, int src_format, 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)
{
    
    void (*ImageFuncs[5]) (unsigned char *dest_ptr, int dest_dx, int dest_dy,
                           int dest_pitch, int dest_bpp, unsigned char *src_ptr,
                           int src_dx, int src_dy, int src_pitch, int src_bpp,
                           void (*row_func) (unsigned char *, int,
                                             unsigned char *, int),
                           void (*row2x_func) (unsigned char *, unsigned char *,
                                               unsigned char *, int,
                                               unsigned char *, int)) =
        {
            IMAGE_SHRINK,
            IMAGE_COPY,
            IMAGE_STRETCH,
            IMAGE_STRETCH2X,
            IMAGE_STRETCH2XPLUS
        };
    
    void (*RowFuncs[5]) (unsigned char *dest_ptr, int dest_dx,
                         unsigned char *src_ptr, int src_dx) =
        {
            RGB444toRGB444_ROW_SHRINK,
            RGB444toRGB444_ROW_COPY,
            RGB444toRGB444_ROW_STRETCH,
            RGB444toRGB444_ROW_STRETCH2X,
            RGB444toRGB444_ROW_STRETCH2XPLUS
        };


    void (*Row2xFuncs[5]) (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) =
        {
            RGB444toRGB444_ROW2X_SHRINK,
            RGB444toRGB444_ROW2X_COPY,
            RGB444toRGB444_ROW2X_STRETCH,
            RGB444toRGB444_ROW2X_STRETCH2X,
            RGB444toRGB444_ROW2X_STRETCH2XPLUS
        };


    void (*row_proc) (unsigned char *, int, unsigned char *, int);
    void (*row2x_proc) (unsigned char *, unsigned char *, unsigned char *, int,
                        unsigned char *, int);
    void (*image_proc) (unsigned char *, int, int, int, int,
                        unsigned char *, int, int, int, int,
                        void (*)(unsigned char *, int, unsigned char *, int),
                        void (*)(unsigned char *, unsigned char *,
                                 unsigned char *, int, unsigned char *, int));

    register int scale_x, scale_y;


    register int dest_bpp, src_bpp;
    register unsigned char *d, *s;


    if (((unsigned) dest_ptr & 3) || (dest_pitch & 1) ||
        ((unsigned) src_ptr & 3) || (src_pitch & 1) ||
        dest_width <= 0 || dest_height <= 0 ||
        src_width <= 0 || src_height <= 0 ||
        dest_x < 0 || dest_y < 0 || dest_dx <= 0 || dest_dy <= 0 ||
        src_x < 0 || src_y < 0 || src_dx <= 0 || src_dy <= 0 ||
        dest_width < dest_x + dest_dx || dest_height < dest_y + dest_dy ||
        src_width < src_x + src_dx || src_height < src_y + src_dy)
    {

        return -1;
    }


    scale_x = 1;
    if (dest_dx != src_dx)
    {
        if (dest_dx < src_dx)
            scale_x--;
        else
        {
            scale_x++;
            if (dest_dx >= 2 * src_dx)
            {
                scale_x++;
                if (dest_dx > 2 * src_dx)
                    scale_x++;
            }
        }
    }

    scale_y = 1;
    if (dest_dy != src_dy)
    {
        if (dest_dy < src_dy)
            scale_y--;
        else
        {
            scale_y++;
            if (dest_dy >= 2 * src_dy)
            {
                scale_y++;
                if (dest_dy > 2 * src_dy)
                    scale_y++;
            }
        }
    }


    row_proc   = RowFuncs[scale_x];
    row2x_proc = Row2xFuncs[scale_x];
    image_proc = ImageFuncs[scale_y];

    if (!row_proc || !row2x_proc || !image_proc)
    {
        return -1;
    }

    dest_bpp = 2;
    src_bpp = 4;

    if (dest_pitch < 0)
        dest_ptr -= (dest_height - 1) * dest_pitch;
    if (src_pitch < 0)
        src_ptr -= (src_height - 1) * src_pitch;


    d = dest_ptr + dest_x * dest_bpp + dest_y * dest_pitch;
    s = src_ptr + src_x * src_bpp + src_y * src_pitch;


    (*image_proc) (d, dest_dx, dest_dy, dest_pitch, dest_bpp,
                   s, src_dx, src_dy, src_pitch, src_bpp, row_proc, row2x_proc);


    return 0;
}





int
RGB444toRGB444 (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,
               color_data_t * not_used)
{
    const int dest_format = 18;	/* RGB444 */
    const int src_format = 18;	/* RGB444 */
    return RGBtoRGB4 (dest_format, dest_ptr, dest_width, dest_height, dest_pitch,
                     dest_x, dest_y, dest_dx, dest_dy, src_format,
                     src_ptr, src_width, src_height, src_pitch,
                     src_x, src_y, src_dx, src_dy);
}