开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > Symbian > 查看源码
444v565.c
资源名称：helix.src.0812.rar　[点击查看]
上传用户：zhongxx05
上传日期：2007-06-06
资源大小：33641k
文件大小：32k
源码类别：

Symbian

开发平台：

C/C++

444v565.c：源码内容
  1. /* ***** BEGIN LICENSE BLOCK ***** 
  2.  * Version: RCSL 1.0/RPSL 1.0 
  3.  *  
  4.  * Portions Copyright (c) 1995-2002 RealNetworks, Inc. All Rights Reserved. 
  5.  *      
  6.  * The contents of this file, and the files included with this file, are 
  7.  * subject to the current version of the RealNetworks Public Source License 
  8.  * Version 1.0 (the "RPSL") available at 
  9.  * http://www.helixcommunity.org/content/rpsl unless you have licensed 
  10.  * the file under the RealNetworks Community Source License Version 1.0 
  11.  * (the "RCSL") available at http://www.helixcommunity.org/content/rcsl, 
  12.  * in which case the RCSL will apply. You may also obtain the license terms 
  13.  * directly from RealNetworks.  You may not use this file except in 
  14.  * compliance with the RPSL or, if you have a valid RCSL with RealNetworks 
  15.  * applicable to this file, the RCSL.  Please see the applicable RPSL or 
  16.  * RCSL for the rights, obligations and limitations governing use of the 
  17.  * contents of the file.  
  18.  *  
  19.  * This file is part of the Helix DNA Technology. RealNetworks is the 
  20.  * developer of the Original Code and owns the copyrights in the portions 
  21.  * it created. 
  22.  *  
  23.  * This file, and the files included with this file, is distributed and made 
  24.  * available on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER 
  25.  * EXPRESS OR IMPLIED, AND REALNETWORKS HEREBY DISCLAIMS ALL SUCH WARRANTIES, 
  26.  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY, FITNESS 
  27.  * FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT. 
  28.  * 
  29.  * Technology Compatibility Kit Test Suite(s) Location: 
  30.  *    http://www.helixcommunity.org/content/tck 
  31.  * 
  32.  * Contributor(s): 
  33.  *  
  34.  * ***** END LICENSE BLOCK ***** */ 
  36. #include <stdlib.h>
  37. #include "nostatic/colorlib.h"
  38. #include "nostatic/yuv.h"
  40. /*
  41.  * Format-conversion routines.
  42.  * Use:
  43.  *  int XXXXtoYYYYEx (unsigned char *dest_ptr, int dest_width, int dest_height,
  44.  *      int dest_pitch, int dest_x, int dest_y, int dest_dx, int dest_dy,
  45.  *      unsigned char *src_ptr, int src_width, int src_height, int src_pitch,
  46.  *      int src_x, int src_y, int src_dx, int src_dy);
  47.  * Input:
  48.  *  dest_ptr - pointer to a destination buffer
  49.  *  dest_width, dest_height - width/height of the destination image (pixels)
  50.  *  dest_pitch - pitch of the dest. buffer (in bytes; <0 - if bottom up image)
  51.  *  dest_x, dest_y, dest_dx, dest_dy - destination rectangle (pixels)
  52.  *  src_ptr - pointer to an input image
  53.  *  src_width, src_height - width/height of the input image (pixels)
  54.  *  src_pitch - pitch of the source buffer (in bytes; <0 - if bottom up image)
  55.  *  src_x, src_y, src_dx, src_dy - source rectangle (pixels)
  56.  * Returns:
  57.  *  0 - if success; -1 if failure.
  58.  * Notes:
  59.  *  a) In all cases, pointers to the source and destination buffers must be
  60.  *     DWORD aligned, and both pitch parameters must be multiple of 4!!!
  61.  *  b) Converters that deal with YUV 4:2:2, or 4:2:0 formats may also require
  62.  *     rectangle parameters (x,y,dx,dy) to be multiple of 2. Failure to provide
  63.  *     aligned rectangles will result in partially converted image.
  64.  *  c) Currently only scale factors of 1:1 and 2:1 are supported; if the rates
  65.  *     dest_dx/src_dx & dest_dy/src_dy are neither 1, or 2, the converters
  66.  *     will fail.
  67.  */
  69. #define BYTESPERPIXEL 2
  71. /* Indexing tables */
  72. static const int next[3] = {1, 2, 0};                 /* (ibuf+1)%3 table */
  73. static const int next2[3] = {2, 0, 1};                /* (ibuf+2)%3 table */
  75. /* Half resolution converter.  */
  76. static void halfI420toRGB444v565 (unsigned char *d1,
  77. int dest_x, unsigned char *sy1, 
  78. unsigned char *sy2, unsigned char *su, 
  79. unsigned char *sv, int src_x, int dx, int isodd,
  80.   color_data_t* pcd)
  81. {
  82.   /* check if we have misaligned input/output: */
  83.   if ((src_x ^ dest_x) & 1) {
  84.     
  85.     ; /* not implemented yet */
  86.     
  87.   } else {
  88.     
  89.     /* aligned input/output: */
  90.     register int y11, y12;
  91.     register int rv1, guv1, bu1, rv2, guv2, bu2;
  92.     register int i;
  93.     
  94.     /* source width should always be multiples of 4 */
  95.     /*    assert((src_x & 3)==0); */
  97.     /* convert all integral 2x4 blocks: */
  98.     if (isodd)
  99.       for (i = 0; i < dx/4; i ++) {
  101. /* first 2x2 block */
  102. rv1 = pcd->rvtab[sv[0]];
  103. guv1 = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  104. bu1 = pcd->butab[su[0]];
  105. y11 = (pcd->ytab[sy1[0]] + pcd->ytab[sy1[1]] + pcd->ytab[sy2[0]] + pcd->ytab[sy2[1]])>>2; /* avg */
  107. /* second 2x2 block */
  108. rv2  = pcd->rvtab[sv[1]];
  109. guv2 = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
  110. bu2  = pcd->butab[su[1]];
  111. y12 = (pcd->ytab[sy1[2]] + pcd->ytab[sy1[3]] + pcd->ytab[sy2[2]] + pcd->ytab[sy2[3]])>>2;
  113. /* output 4 bytes at a time */
  114. *(unsigned int *)(d1+0) =
  115.   (CLIP4[y11 + bu1  + DITH4L] << 1)  |
  116.   (CLIP4[y11 + guv1 + DITH4L] << 7)  |
  117.   (CLIP4[y11 + rv1  + DITH4L] << 12) |
  118.   (CLIP4[y12 + bu2  + DITH4H] << 17) |
  119.   (CLIP4[y12 + guv2 + DITH4H] << 23) |
  120.   (CLIP4[y12 + rv2  + DITH4H] << 28) ;
  122. /* next 4x2 block */
  123. sy1 += 4; sy2 += 4;
  124. su += 2; sv += 2;
  125. d1 += 2*BPP2;
  126.       }
  127.     else
  128.       for (i = 0; i < dx/4; i ++) {
  130. /* first 2x2 block */
  131. rv1 = pcd->rvtab[sv[0]];
  132. guv1 = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  133. bu1 = pcd->butab[su[0]];
  134. y11 = (pcd->ytab[sy1[0]] + pcd->ytab[sy1[1]] + pcd->ytab[sy2[0]] + pcd->ytab[sy2[1]])>>2; /* avg */
  136. /* second 2x2 block */
  137. rv2  = pcd->rvtab[sv[1]];
  138. guv2 = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
  139. bu2  = pcd->butab[su[1]];
  140. y12 = (pcd->ytab[sy1[2]] + pcd->ytab[sy1[3]] + pcd->ytab[sy2[2]] + pcd->ytab[sy2[3]])>>2;
  142. /* output 4 bytes at a time */
  143. *(unsigned int *)(d1+0) =
  144.   (CLIP4[y11 + bu1  + DITH4H] << 1)  |
  145.   (CLIP4[y11 + guv1 + DITH4H] << 7)  |
  146.   (CLIP4[y11 + rv1  + DITH4H] << 12) |
  147.   (CLIP4[y12 + bu2  + DITH4L] << 17) |
  148.   (CLIP4[y12 + guv2 + DITH4L] << 23) |
  149.   (CLIP4[y12 + rv2  + DITH4L] << 28) ;
  151. /* next 4x2 block */
  152. sy1 += 4; sy2 += 4;
  153. su += 2; sv += 2;
  154. d1 += 2*BPP2;
  155.       }
  157.   }
  158. }
  160. static void dblineI420toRGB444v565 (unsigned char *d1, unsigned char *d2, 
  161. int dest_x, unsigned char *sy1, 
  162. unsigned char *sy2, unsigned char *su, 
  163. unsigned char *sv, int src_x, int dx,
  164.     color_data_t* pcd)
  165. {
  166.     /* check if we have misaligned input/output: */
  167.     if ((src_x ^ dest_x) & 1) {
  169.         ; /* not implemented yet */
  171.     } else {
  173.         /* aligned input/output: */
  174.         register int y11, y12, y21, y22;
  175.         register int rv, guv, bu;
  176.         register int i;
  178.         /* convert first 2x1 block: */
  179.         if (dest_x & 1) {
  181.             rv  = pcd->rvtab[sv[0]];
  182.             guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  183.             bu  = pcd->butab[su[0]];
  184.             y11 = pcd->ytab[sy1[0]];
  185.             y21 = pcd->ytab[sy2[0]];
  187.             /* output 2 bytes at a time */
  188.             *(unsigned short *)(d1+0) =
  189.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  190.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  191.                 (CLIP4[y11 + rv  + DITH4L] << 12) ;
  193.             *(unsigned short *)(d2+0) =
  194.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  195.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  196.                 (CLIP4[y21 + rv  + DITH4H] << 12) ;
  198.             sy1 += 1; sy2 += 1;
  199.             su += 1; sv += 1;
  200.             d1 += BPP2; d2 += BPP2;
  201.             dest_x ++; dx --;
  202.         }
  204.         /* convert first 2x2 block: */
  205.         if (dest_x & 2) {
  207.             rv  = pcd->rvtab[sv[0]];
  208.             guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  209.             bu  = pcd->butab[su[0]];
  210.             y11 = pcd->ytab[sy1[0]];
  211.             y12 = pcd->ytab[sy1[1]];
  213.             /* output 4 bytes at a time */
  214.             *(unsigned int *)(d1+0) =
  215.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  216.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  217.                 (CLIP4[y11 + rv  + DITH4L] << 12) |
  218.                 (CLIP4[y12 + bu  + DITH4H] << 17) |
  219.                 (CLIP4[y12 + guv + DITH4H] << 23) |
  220.                 (CLIP4[y12 + rv  + DITH4H] << 28) ;
  222.             y21 = pcd->ytab[sy2[0]];
  223.             y22 = pcd->ytab[sy2[1]];
  225.             *(unsigned int *)(d2+0) =
  226.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  227.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  228.                 (CLIP4[y21 + rv  + DITH4H] << 12) |
  229.                 (CLIP4[y22 + bu  + DITH4L] << 17) |
  230.                 (CLIP4[y22 + guv + DITH4L] << 23) |
  231.                 (CLIP4[y22 + rv  + DITH4L] << 28) ;
  233.             sy1 += 2; sy2 += 2;
  234.             su += 1; sv += 1;
  235.             d1 += 2*BPP2; d2 += 2*BPP2;
  236.             dest_x += 2; dx -= 2;
  237.         }
  239.         /* convert all integral 2x4 blocks: */
  240.         for (i = 0; i < dx/4; i ++) {
  242.             /* first 2x2 block */
  243.             rv = pcd->rvtab[sv[0]];
  244.             guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  245.             bu = pcd->butab[su[0]];
  246.             y11 = pcd->ytab[sy1[0]];
  247.             y12 = pcd->ytab[sy1[1]];
  249.             /* output 4 bytes at a time */
  250.             *(unsigned int *)(d1+0) =
  251.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  252.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  253.                 (CLIP4[y11 + rv  + DITH4L] << 12) |
  254.                 (CLIP4[y12 + bu  + DITH4H] << 17) |
  255.                 (CLIP4[y12 + guv + DITH4H] << 23) |
  256.                 (CLIP4[y12 + rv  + DITH4H] << 28) ;
  258.             y21 = pcd->ytab[sy2[0]];
  259.             y22 = pcd->ytab[sy2[1]];
  261.             *(unsigned int *)(d2+0) =
  262.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  263.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  264.                 (CLIP4[y21 + rv  + DITH4H] << 12) |
  265.                 (CLIP4[y22 + bu  + DITH4L] << 17) |
  266.                 (CLIP4[y22 + guv + DITH4L] << 23) |
  267.                 (CLIP4[y22 + rv  + DITH4L] << 28) ;
  269.             /* second 2x2 block */
  270.             rv  = pcd->rvtab[sv[1]];
  271.             guv = pcd->gutab[su[1]] + pcd->gvtab[sv[1]];
  272.             bu  = pcd->butab[su[1]];
  273.             y11 = pcd->ytab[sy1[2]];
  274.             y12 = pcd->ytab[sy1[3]];
  276.             *(unsigned int *)(d1+2*BPP2) =
  277.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  278.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  279.                 (CLIP4[y11 + rv  + DITH4L] << 12) |
  280.                 (CLIP4[y12 + bu  + DITH4H] << 17) |
  281.                 (CLIP4[y12 + guv + DITH4H] << 23) |
  282.                 (CLIP4[y12 + rv  + DITH4H] << 28) ;
  284.             y21 = pcd->ytab[sy2[2]];
  285.             y22 = pcd->ytab[sy2[3]];
  287.             *(unsigned int *)(d2+2*BPP2) =
  288.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  289.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  290.                 (CLIP4[y21 + rv  + DITH4H] << 12) |
  291.                 (CLIP4[y22 + bu  + DITH4L] << 17) |
  292.                 (CLIP4[y22 + guv + DITH4L] << 23) |
  293.                 (CLIP4[y22 + rv  + DITH4L] << 28) ;
  295.             /* next 4x2 block */
  296.             sy1 += 4; sy2 += 4;
  297.             su += 2; sv += 2;
  298.             d1 += 4*BPP2; d2 += 4*BPP2;
  299.         }
  301.         /* convert last 2x2 block: */
  302.         if (dx & 2) {
  304.             rv = pcd->rvtab[sv[0]];
  305.             guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  306.             bu = pcd->butab[su[0]];
  307.             y11 = pcd->ytab[sy1[0]];
  308.             y12 = pcd->ytab[sy1[1]];
  310.             /* output 4 bytes at a time */
  311.             *(unsigned int *)(d1+0) =
  312.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  313.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  314.                 (CLIP4[y11 + rv  + DITH4L] << 12) |
  315.                 (CLIP4[y12 + bu  + DITH4H] << 17) |
  316.                 (CLIP4[y12 + guv + DITH4H] << 23) |
  317.                 (CLIP4[y12 + rv  + DITH4H] << 28) ;
  319.             y21 = pcd->ytab[sy2[0]];
  320.             y22 = pcd->ytab[sy2[1]];
  322.             *(unsigned int *)(d2+0) =
  323.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  324.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  325.                 (CLIP4[y21 + rv  + DITH4H] << 12) |
  326.                 (CLIP4[y22 + bu  + DITH4L] << 17) |
  327.                 (CLIP4[y22 + guv + DITH4L] << 23) |
  328.                 (CLIP4[y22 + rv  + DITH4L] << 28) ;
  330.             sy1 += 2; sy2 += 2;
  331.             su += 1; sv += 1;
  332.             d1 += 2*BPP2; d2 += 2*BPP2;
  333.             dx -= 2;
  334.         }
  336.         /* convert last 2x1 block: */
  337.         if (dx & 1) {
  339.             rv  = pcd->rvtab[sv[0]];
  340.             guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  341.             bu  = pcd->butab[su[0]];
  342.             y11 = pcd->ytab[sy1[0]];
  343.             y21 = pcd->ytab[sy2[0]];
  345.             /* output 2 bytes at a time */
  346.             *(unsigned short *)(d1+0) =
  347.                 (CLIP4[y11 + bu  + DITH4L] << 1)  |
  348.                 (CLIP4[y11 + guv + DITH4L] << 7)  |
  349.                 (CLIP4[y11 + rv  + DITH4L] << 12) ;
  351.             *(unsigned short *)(d2+0) =
  352.                 (CLIP4[y21 + bu  + DITH4H] << 1)  |
  353.                 (CLIP4[y21 + guv + DITH4H] << 7)  |
  354.                 (CLIP4[y21 + rv  + DITH4H] << 12) ;
  355.         }
  356.     }
  357. }
  359. #define DITH1X4L 0x01002004
  360. #define DITH1X4H 0x0300600C
  362. #define DITH2X4L 0x02004008
  363. #define DITH2X4H 0x0600C018
  365. #define DITH4X4L 0x04008010
  366. #define DITH4X4H 0x0C018030
  368. #define DITHER_MAGIC 0xc0380700
  371. /* RGB444 version: */
  372. static void dblineXRGBtoRGB444v565x2 (unsigned char *d1, unsigned char *d2, int dest_x,
  373.       unsigned char *s1, unsigned char *s2, int src_x, int dx,
  374.   color_data_t* pcd)
  375. {
  376.     register unsigned int a, b, c, d, e, f;
  377.     register unsigned int w, x, y, z;
  379.     /* convert first 2x1 block: */
  380.     if (dest_x & 1) {
  382.         /* Input pels  =>   Output pels
  383.          *  a b             w  x
  384.          *  c d             w' x'
  385.          */
  387.         /* top line */
  388.         a = *(unsigned int *)s1;
  389.         b = *(unsigned int *)(s1+BPP4);
  391.         w = a     + DITH1X4L;
  392.         x = a + b + DITH2X4H;
  394.         /* pack and store */
  395.         *(unsigned int *)d1 =
  396.             ((w & 0x000000f0) >> 3)  |
  397.             ((w & 0x00078000) >> 8) |
  398.             ((w & 0x3c000000) >> 14) |
  399.             ((x & 0x000001e0) << 12) |
  400.             ((x & 0x000f0000) << 7)  |
  401.             ((x & 0x78000000) << 1);
  403.         /* bottom line */
  404.         c = *(unsigned int *)s2;
  405.         d = *(unsigned int *)(s2+BPP4);
  407.         w = a + c         + DITH2X4H;
  408.         x = a + b + c + d + DITH4X4L;
  410.         /* pack and store */
  411.         *(unsigned int *)d2 =
  412.             ((w & 0x000001e0) >> 4)  |
  413.             ((w & 0x000f0000) >> 9) |
  414.             ((w & 0x78000000) >> 15) |
  415.             ((x & 0x000003c0) << 11) |
  416.             ((x & 0x001e0000) << 6)  |
  417.             ((x & 0xf0000000) << 0);
  419.         /* bump pointers to next block */
  420.         s1 += BPP4; s2 += BPP4;
  421.         d1 += 2*BPP2; d2 += 2*BPP2;
  422.         dx -= 1;
  423.     }
  425.     /* process all integral 2x2 blocks: */
  426.     while (dx > 2) {    /* we need to leave at least one block */
  428.         /*
  429.          * Input stored as 00 RRRRRRRR 000 GGGGGGGG 000 BBBBBBBB
  430.          *
  431.          * Input pels       Output pels
  432.          *  a b e           w  x  y  z
  433.          *  c d f           w' x' y' z'
  434.          */
  436.         /* top line */
  437.         a = *(unsigned int *)s1;
  438.         b = *(unsigned int *)(s1+BPP4);
  439.         e = *(unsigned int *)(s1+2*BPP4);
  441. w = a     + DITH1X4L;
  442. x = a + b + DITH2X4H;
  443. y = b     + DITH1X4L;
  444. z = b + e + DITH2X4H;
  446.         /* pack and store */
  447.         *(unsigned int *)d1 =
  448.             ((w & 0x000000f0) >> 3)  |
  449.             ((w & 0x00078000) >> 8)  |
  450.             ((w & 0x3c000000) >> 14) |
  451.             ((x & 0x000001e0) << 12) |
  452.             ((x & 0x000f0000) << 7)  |
  453.             ((x & 0x78000000) << 1);
  454.         *(unsigned int *)(d1+2*BPP2) =
  455.             ((y & 0x000000f0) >> 3)  |
  456.             ((y & 0x00078000) >> 8)  |
  457.             ((y & 0x3c000000) >> 14) |
  458.             ((z & 0x000001e0) << 12) |
  459.             ((z & 0x000f0000) << 7)  |
  460.             ((z & 0x78000000) << 1);
  462.         /* bottom line */
  463.         c = *(unsigned int *)s2;
  464.         d = *(unsigned int *)(s2+BPP4);
  465.         f = *(unsigned int *)(s2+2*BPP4);
  467. w = a + c         + DITH2X4H;
  468. x = a + b + c + d + DITH4X4L;
  469. y = b + d         + DITH2X4H;
  470. z = b + e + d + f + DITH4X4L;
  472.         /* pack and store */
  473.         *(unsigned int *)d2 =
  474.             ((w & 0x000001e0) >> 4)  |
  475.             ((w & 0x000f0000) >> 9)  |
  476.             ((w & 0x78000000) >> 15) |
  477.             ((x & 0x000003c0) << 11) |
  478.             ((x & 0x001e0000) << 6)  |
  479.             ((x & 0xf0000000) << 0);
  480.         *(unsigned int *)(d2+2*BPP2) =
  481.             ((y & 0x000001e0) >> 4)  |
  482.             ((y & 0x000f0000) >> 9)  |
  483.             ((y & 0x78000000) >> 15) |
  484.             ((z & 0x000003c0) << 11) |
  485.             ((z & 0x001e0000) << 6)  |
  486.             ((z & 0xf0000000) << 0);
  488.         /* next 2x2 input block */
  489.         s1 += 2*BPP4; s2 += 2*BPP4;
  490.         d1 += 4*BPP2; d2 += 4*BPP2;
  491.         dx -= 2;
  492.     }
  494.     /* check if this is the last 2x2 block: */
  495.     if (dx > 1) {
  497.         /*
  498.          * For last 4 output pels, repeat final input pel
  499.          * for offscreen input.  Equivalent to pixel-doubling the
  500.          * last output pel.
  501.          */
  503.         /* top line */
  504.         a = *(unsigned int *)s1;
  505.         b = *(unsigned int *)(s1+BPP4);
  506.         e = b;      /* repeat last input pel */
  508.         w = a     + DITH1X4L;
  509.         x = a + b + DITH2X4H;
  510.         y = b     + DITH1X4L;
  511.         z = b + e + DITH2X4H;
  513.         /* pack and store */
  514.         *(unsigned int *)d1 =
  515.             ((w & 0x000000f0) >> 3)  |
  516.             ((w & 0x00078000) >> 8)  |
  517.             ((w & 0x3c000000) >> 14) |
  518.             ((x & 0x000001e0) << 12) |
  519.             ((x & 0x000f0000) << 7)  |
  520.             ((x & 0x78000000) << 1);
  521.         *(unsigned int *)(d1+2*BPP2) =
  522.             ((y & 0x000000f0) >> 3)  |
  523.             ((y & 0x00078000) >> 8)  |
  524.             ((y & 0x3c000000) >> 14) |
  525.             ((z & 0x000001e0) << 12) |
  526.             ((z & 0x000f0000) << 7)  |
  527.             ((z & 0x78000000) << 1);
  529.         /* bottom line */
  530.         c = *(unsigned int *)s2;
  531.         d = *(unsigned int *)(s2+BPP4);
  532.         f = d;      /* repeat last input pel */
  534.         w = a + c         + DITH2X4H;
  535.         x = a + b + c + d + DITH4X4L;
  536.         y = b + d         + DITH2X4H;
  537.         z = b + e + d + f + DITH4X4L;
  539.         *(unsigned int *)d2 =
  540.             ((w & 0x000001e0) >> 4)  |
  541.             ((w & 0x000f0000) >> 9)  |
  542.             ((w & 0x78000000) >> 15) |
  543.             ((x & 0x000003c0) << 11) |
  544.             ((x & 0x001e0000) << 6)  |
  545.             ((x & 0xf0000000) << 0);
  546.         *(unsigned int *)(d2+2*BPP2) =
  547.             ((y & 0x000001e0) >> 4)  |
  548.             ((y & 0x000f0000) >> 9)  |
  549.             ((y & 0x78000000) >> 15) |
  550.             ((z & 0x000003c0) << 11) |
  551.             ((z & 0x001e0000) << 6)  |
  552.             ((z & 0xf0000000) << 0);
  554.     } else {
  555.         /* last 2x1 block: */
  557.         /* Input pels  =>   Output pels
  558.          *  a b             w  x
  559.          *  c d             w' x'
  560.          */
  562.         /* top line */
  563.         a = *(unsigned int *)s1;
  564.         b = a;      /* repeat last input pel */
  566.         w = a     + DITH1X4L;
  567.         x = a + b + DITH2X4H;
  569.         /* pack and store */
  570.         *(unsigned int *)d1 =
  571.             ((w & 0x000000f0) >> 3)  |
  572.             ((w & 0x00078000) >> 8)  |
  573.             ((w & 0x3c000000) >> 14) |
  574.             ((x & 0x000001e0) << 12) |
  575.             ((x & 0x000f0000) << 7)  |
  576.             ((x & 0x78000000) << 1);
  578.         /* bottom line */
  579.         c = *(unsigned int *)s2;
  580.         d = c;      /* repeat last input pel */
  582.         w = a + c         + DITH2X4H;
  583.         x = a + b + c + d + DITH4X4L;
  585.         /* pack and store */
  586.         *(unsigned int *)d2 =
  587.             ((w & 0x000001e0) >> 4)  |
  588.             ((w & 0x000f0000) >> 9)  |
  589.             ((w & 0x78000000) >> 15) |
  590.             ((x & 0x000003c0) << 11) |
  591.             ((x & 0x001e0000) << 6)  |
  592.             ((x & 0xf0000000) << 0);
  593.     }
  594. }
  596. /*
  597.  * Convert two YUV lines into RGB linebufs.
  598.  * Produces two RGB lines per call.
  599.  * Output in padded RGB format, needed for SIMD interpolation.
  600.  */
  601. static void dblineI420toXRGB (unsigned char *d1, unsigned char *d2, int dest_x,
  602.     unsigned char *sy1, unsigned char *sy2, unsigned char *su, unsigned char *sv,
  603.       int src_x, int dx,
  604.       color_data_t* pcd)
  605. {
  606.     register int y1, y2, rv, guv, bu;
  607.     register int i;
  609.     /* convert first 2x1 block: */
  610.     if (src_x & 1) {
  612.         bu = pcd->butab[su[0]];
  613.         guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  614.         rv = pcd->rvtab[sv[0]];
  615.         y1 = pcd->ytab[sy1[0]];
  616.         y2 = pcd->ytab[sy2[0]];
  618.         /* first line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  619.         *(unsigned int *)(d1+0) =
  620.             (CLIP8[y1 + bu])        |
  621.             (CLIP8[y1 + guv] << 11) |
  622.             (CLIP8[y1 + rv]  << 22) ;
  624.         /* second line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  625.         *(unsigned int *)(d2+0) =
  626.             (CLIP8[y2 + bu])        |
  627.             (CLIP8[y2 + guv] << 11) |
  628.             (CLIP8[y2 + rv]  << 22) ;
  630.         sy1 += 1; sy2 += 1;
  631.         su += 1; sv += 1;
  632.         d1 += BPP4; d2 += BPP4;
  633.         dx --;
  634.     }
  636.     /* convert all integral 2x2 blocks: */
  637.     for (i = 0; i < dx/2; i ++) {
  639.         bu = pcd->butab[su[0]];
  640.         guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  641.         rv = pcd->rvtab[sv[0]];
  642.         y1 = pcd->ytab[sy1[0]];
  643.         y2 = pcd->ytab[sy2[0]];
  645.         /* first line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  646.         *(unsigned int *)(d1+0) =
  647.             (CLIP8[y1 + bu])        |
  648.             (CLIP8[y1 + guv] << 11) |
  649.             (CLIP8[y1 + rv]  << 22) ;
  651.         /* second line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  652.         *(unsigned int *)(d2+0) =
  653.             (CLIP8[y2 + bu])        |
  654.             (CLIP8[y2 + guv] << 11) |
  655.             (CLIP8[y2 + rv]  << 22) ;
  657.         /* 2nd row: */
  658.         y1 = pcd->ytab[sy1[1]];
  659.         y2 = pcd->ytab[sy2[1]];
  661.         /* first line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  662.         *(unsigned int *)(d1+BPP4) =
  663.             (CLIP8[y1 + bu])        |
  664.             (CLIP8[y1 + guv] << 11) |
  665.             (CLIP8[y1 + rv]  << 22) ;
  667.         /* second line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  668.         *(unsigned int *)(d2+BPP4) =
  669.             (CLIP8[y2 + bu])        |
  670.             (CLIP8[y2 + guv] << 11) |
  671.             (CLIP8[y2 + rv]  << 22) ;
  673.         /* next 2x2 block */
  674.         sy1 += 2; sy2 += 2;
  675.         su += 1; sv += 1;
  676.         d1 += 2*BPP4; d2 += 2*BPP4;
  677.     }
  679.     /* convert last 2x1 block: */
  680.     if (dx & 1) {
  682.         bu = pcd->butab[su[0]];
  683. guv = pcd->gutab[su[0]] + pcd->gvtab[sv[0]];
  684.         rv = pcd->rvtab[sv[0]];
  685.         y1 = pcd->ytab[sy1[0]];
  686.         y2 = pcd->ytab[sy2[0]];
  688.         /* first line 00rrrrrr.rr000ggg.ggggg000.bbbbbbbb: */
  689.         *(unsigned int *)(d1+0) =
  690.             (CLIP8[y1 + bu])        |
  691.             (CLIP8[y1 + guv] << 11) |
  692.             (CLIP8[y1 + rv]  << 22) ;
  694.         /* second line BGR0 */
  695.         *(unsigned int *)(d2+0) =
  696.             (CLIP8[y2 + bu])        |
  697.             (CLIP8[y2 + guv] << 11) |
  698.             (CLIP8[y2 + rv]  << 22) ;
  699.     }
  700. }
  702. /*
  703.  * I420->RGB444 converter:
  704.  */
  705. int I420toRGB444v565 (unsigned char *dest_ptr, int dest_width, int dest_height,
  706.     int dest_pitch, int dest_x, int dest_y, int dest_dx, int dest_dy,
  707.     unsigned char *src_ptr, int src_width, int src_height, int src_pitch,
  708.     int src_x, int src_y, int src_dx, int src_dy,
  709.       color_data_t* pcd)
  710. {
  711.     /* scale factors: */
  712.     int scale_x, scale_y;
  714.     /* check arguments: */
  715.     if (!chk_args (dest_ptr, dest_width, dest_height, dest_pitch,
  716.         dest_x, dest_y, dest_dx, dest_dy, src_ptr, src_width, src_height,
  717.         src_pitch, src_x, src_y, src_dx, src_dy, &scale_x, &scale_y))
  718.         return -1;
  720.     /* check if bottop-up images: */
  721.     if (dest_pitch < 0) dest_ptr -= (dest_height-1) * dest_pitch;
  722.     if (src_pitch <= 0) return -1;          /* not supported */
  724.     /* check if 1:1 scale: */
  725.     if (scale_x == 1 && scale_y == 1) {
  727.         /* color converter to use: */
  728.         void (*dbline) (unsigned char *d1, unsigned char *d2, int dest_x,
  729.             unsigned char *sy1, unsigned char *sy2, unsigned char *su, unsigned char *sv,
  730.             int src_x, int dx, color_data_t* pcd) = 
  731.             dblineI420toRGB444v565;
  733.         /* local variables: */
  734.         unsigned char *sy1, *sy2, *su, *sv, *d1, *d2;
  735.         register int j;
  737.         /* get pointers: */
  738.         sy1 = src_ptr + (src_x + src_y * src_pitch);        /* luma offset */
  739.         sy2 = sy1 + src_pitch;
  740.         su  = src_ptr + src_height * src_pitch + (src_x/2 + src_y/2 * src_pitch);
  741.         sv  = su + src_height * src_pitch / 4;
  742.         d1  = dest_ptr + dest_x * 2 + dest_y * dest_pitch; /* RGB offset */
  743.         d2  = d1 + dest_pitch;
  745.         /* convert a top line: */
  746.         if (src_y & 1) {                        /* chroma shift */
  748.             /* this is a bit inefficient, but who cares??? */
  749.             (* dbline) (d1, d1, dest_x, sy1, sy1, su, sv, src_x, src_dx, pcd);
  751.             sy1 += src_pitch;   sy2 += src_pitch;
  752.             su  += src_pitch/2; sv  += src_pitch/2;
  753.             d1  += dest_pitch;  d2  += dest_pitch;
  754.             dest_dy --;
  755.         }
  757.         /* convert aligned portion of the image: */
  758.         for (j = 0; j < dest_dy/2; j ++) {
  760.             /* convert two lines a time: */
  761.             (* dbline) (d1, d2, dest_x, sy1, sy2, su, sv, src_x, src_dx, pcd);
  763.             sy1 += src_pitch*2; sy2 += src_pitch*2;
  764.             su  += src_pitch/2; sv  += src_pitch/2;
  765.             d1  += dest_pitch*2; d2 += dest_pitch*2;
  766.         }
  768.         /* convert bottom line (if dest_dy is odd): */
  769.         if (dest_dy & 1) {
  771.             /* convert one line only: */
  772.             (* dbline) (d1, d1, dest_x, sy1, sy1, su, sv, src_x, src_dx, pcd);
  773.         }
  774.         return 0;
  775.     }
  777.     /* check if 2:1 scale: */
  778.     if (scale_x == 2 && scale_y == 2) {
  779.         /* color converter & interpolator to use: */
  780.         void (*cvt) (unsigned char *d1, unsigned char *d2, int dest_x,
  781.             unsigned char *sy1, unsigned char *sy2, unsigned char *su, unsigned char *sv,
  782.             int src_x, int dx, color_data_t* pcd) = dblineI420toXRGB;
  783.         void (*x2) (unsigned char *d1, unsigned char *d2, int dest_x,
  784.             unsigned char *s1, unsigned char *s2, int src_x, int dx, color_data_t* pcd) = dblineXRGBtoRGB444v565x2;
  786.         /* local variables: */
  787.         unsigned char *sy1, *sy2, *su, *sv, *d1, *d2;
  788.         register int dy = src_dy;
  790.         /* line buffers (we want them to be as compact as possible): */
  791.         int ibuf = 0;                           /* circular buffer index */
  792.         unsigned char * buf[3];                 /* actual pointers  */
  793.         buf[0] = pcd->linebuf;
  794.         buf[1] = pcd->linebuf + src_dx * BPP4;
  795.         buf[2] = pcd->linebuf + 2 * src_dx * BPP4;
  797.         /* get pointers: */
  798.         sy1 = src_ptr + (src_x + src_y * src_pitch);        /* luma offset */
  799.         sy2 = sy1 + src_pitch;
  800.         su  = src_ptr + src_height * src_pitch + (src_x/2 + src_y/2 * src_pitch);
  801.         sv  = su + src_height * src_pitch / 4;
  802.         d1  = dest_ptr + dest_x * BYTESPERPIXEL + dest_y * dest_pitch; /* RGB offset */
  803.         d2  = d1 + dest_pitch;
  805.         /* check if we have misaligned top line: */
  806.         if (src_y & 1) {
  808.             /* convert an odd first line: */
  809.             (*cvt) (buf[ibuf], buf[ibuf], 0, sy1, sy1, su, sv, src_x, src_dx, pcd);
  810.             sy1 += src_pitch;   sy2 += src_pitch;
  811.             su  += src_pitch/2; sv  += src_pitch/2;
  812.             dy --;
  814.         } else {
  816.             /* otherwise, convert first two lines: */
  817.             (*cvt) (buf[next[ibuf]], buf[next2[ibuf]], 0, sy1, sy2, su, sv, src_x, src_dx, pcd);
  818.             sy1 += src_pitch*2; sy2 += src_pitch*2;
  819.             su  += src_pitch/2; sv  += src_pitch/2;
  820.             ibuf = next[ibuf];      /* skip first interpolation: */
  822.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[next[ibuf]], 0, src_dx, pcd);
  823.             d1  += dest_pitch*2; d2  += dest_pitch*2;
  824.             ibuf = next[ibuf];
  825.             dy -= 2;
  826.         }
  828.         /*
  829.          * Convert & interpolate the main portion of image:
  830.          *
  831.          *  source:      temp.store:                destination:
  832.          *
  833.          *               buf[ibuf] -------    /--> d1
  834.          *                                  x2  --> d2
  835.          *  s1 --   /-> buf[next[ibuf]] -<    /--> d1'=d1+2*pitch
  836.          *        cvt                       x2 ---> d2'=d2+2*pitch
  837.          *  s2 --/   -> buf[next2[ibuf]] /
  838.          */
  839.         while (dy >= 2) {
  841.             /* convert two lines into XRGB buffers: */
  842.             (*cvt) (buf[next[ibuf]], buf[next2[ibuf]], 0, sy1, sy2, su, sv, src_x, src_dx, pcd);
  843.             sy1 += src_pitch*2; sy2 += src_pitch*2;
  844.             su  += src_pitch/2; sv  += src_pitch/2;
  846.             /* interpolate first line: */
  847.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[next[ibuf]], 0, src_dx, pcd);
  848.             d1  += dest_pitch*2; d2  += dest_pitch*2;
  849.             ibuf = next[ibuf];
  851.             /* interpolate second one: */
  852.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[next[ibuf]], 0, src_dx, pcd);
  853.             d1  += dest_pitch*2; d2  += dest_pitch*2;
  854.             ibuf = next[ibuf];
  855.             dy -= 2;
  856.         }
  858.         /* check the # of remaining rows: */
  859.         if (dy & 1) {
  861.             /* convert the last odd line: */
  862.             (*cvt) (buf[next[ibuf]], buf[next[ibuf]], 0, sy1, sy1, su, sv, src_x, src_dx, pcd);
  864.             /* interpolate first line: */
  865.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[next[ibuf]], 0, src_dx, pcd);
  866.             d1  += dest_pitch*2; d2  += dest_pitch*2;
  867.             ibuf = next[ibuf];
  869.             /* replicate the last line: */
  870.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[ibuf], 0, src_dx, pcd);
  872.         } else {
  874.             /* replicate the last line: */
  875.             (*x2) (d1, d2, dest_x, buf[ibuf], buf[ibuf], 0, src_dx, pcd);
  876.         }
  877.         return 0;
  878.     }
  880.     /* check for 1/2 X scaling */
  881.     if (scale_x == 0 && scale_y == 0) {
  883.         /* local variables: */
  884.         unsigned char *sy1, *sy2, *su, *sv, *d1, *d2;
  885.         register int j;
  887.         /* get pointers: */
  888.         sy1 = src_ptr + (src_x + src_y * src_pitch);        /* luma offset */
  889.         sy2 = sy1 + src_pitch;
  890.         su  = src_ptr + src_height * src_pitch + (src_x/2 + src_y/2 * src_pitch);
  891.         sv  = su + src_height * src_pitch / 4;
  892.         d1  = dest_ptr + dest_x * 2 + dest_y * dest_pitch; /* RGB offset */
  893.         d2  = d1 + dest_pitch;
  895.         /* convert aligned portion of the image: */
  896.         for (j = 0; j < dest_dy>>1; j ++) {
  898.             /* convert two lines a time: */
  899.             halfI420toRGB444v565 (d1, dest_x, sy1, sy2, su, sv, src_x, src_dx, 0, pcd);
  900.             sy1 += src_pitch*2; sy2 += src_pitch*2;
  901.             su  += src_pitch/2; sv  += src_pitch/2;
  902.             d1  += dest_pitch;
  904.             halfI420toRGB444v565 (d1, dest_x, sy1, sy2, su, sv, src_x, src_dx, 1, pcd);
  905.             sy1 += src_pitch*2; sy2 += src_pitch*2;
  906.             su  += src_pitch/2; sv  += src_pitch/2;
  907.             d1  += dest_pitch;
  908.         }
  910.         return 0;
  911.     }
  913.     /* conversion is not supported */
  914.     return -1;
  915. }
  917. /*
  918.  * InitI420toRGB444v565 initializes the minimum set of clip tables necessary to perform
  919.  * color conversion to 12 bit RGB packed into a 565 value.  The 8-bit clip table is 
  920.  * necessary for 2x interpolation.
  921.  *
  922.  * This routine also calls SetSrcI420Colors, which initializes color conversion tables
  923.  * and adds color balance.
  924.  */
  925. void InitI420toRGB444v565(float brightness, float contrast, float saturation, float hue, 
  926.   color_data_t* pcd)
  927. {
  928.     InitColorData(pcd);
  929.     SetSrcI420Colors (brightness, contrast, saturation, hue, pcd);
  930. }
  932. void UninitI420toRGB444v565( ){
  933.     /* noop */
  934. }