2111 lines
58 KiB
C
2111 lines
58 KiB
C
/*
|
|
* Microsoft YUV Codec -yuv411 -> rgb conversion functions
|
|
*
|
|
* Copyright (c) Microsoft Corporation 1993
|
|
* All Rights Reserved
|
|
*
|
|
*/
|
|
/*
|
|
* for TOSHIBA Pistachio yuv12 -> rgb conversion functions
|
|
*
|
|
* Programed by Y.Kasai 05/27/97
|
|
*
|
|
* supported type:
|
|
* YUV411 (for Bravado)
|
|
* YUV422 (for Spigot)
|
|
* YUV12 (for Pistachio)
|
|
* YUV9 (for Pistachio)
|
|
*/
|
|
|
|
#include <windows.h>
|
|
#include <windowsx.h>
|
|
|
|
#include "msyuv.h"
|
|
|
|
/*
|
|
* This module provides translation from YUV into RGB. It translates
|
|
* from 8-bit YUV 4:2:2 (as provided by the Spigot video capture driver)
|
|
* or 7-bit YUV 4:1:1 (as provided by the Bravado driver) into 16-bit RGB555
|
|
* or RGB565. All versions use a look-up table built using YUVToRGB555
|
|
* or YUVToRGB565
|
|
*/
|
|
|
|
|
|
|
|
#define RANGE(x, lo, hi) max(lo, min(hi, x))
|
|
|
|
/*
|
|
* Convert a YUV colour into a 15-bit RGB colour.
|
|
*
|
|
* The input Y is in the range 16..235; the input U and V components
|
|
* are in the range -128..+127. The conversion equations for this are
|
|
* (according to CCIR 601):
|
|
*
|
|
* R = Y + 1.371 V
|
|
* G = Y - 0.698 V - 0.336 U
|
|
* B = Y + 1.732 U
|
|
*
|
|
* To avoid floating point, we scale all values by 1024.
|
|
*
|
|
* The resulting RGB values are in the range 16..235: we truncate these to
|
|
* 5 bits each. and return a WORD containing 5-bits each for R, G and B
|
|
* with bit 15 set to 0.
|
|
*/
|
|
WORD
|
|
YUVToRGB555(int y, int u, int v)
|
|
{
|
|
int ScaledY = RANGE(y, 16, 235) * 1024;
|
|
int red, green, blue;
|
|
|
|
red = RANGE((ScaledY + (1404 * v)) / 1024, 0, 255);
|
|
green = RANGE( (ScaledY - (715 * v) - (344 * u)) / 1024, 0, 255);
|
|
blue = RANGE( (ScaledY + (1774 * u)) / 1024, 0, 255);
|
|
|
|
return (WORD) (((red & 0xf8) << 7) | ((green & 0xf8) << 2) | ((blue & 0xf8) >>3) );
|
|
}
|
|
|
|
|
|
// same as above but converts to RGB565 instead
|
|
WORD
|
|
YUVToRGB565(int y, int u, int v)
|
|
{
|
|
int ScaledY = RANGE(y, 16, 235) * 1024;
|
|
int red, green, blue;
|
|
|
|
red = RANGE((ScaledY + (1404 * v)) / 1024, 0, 255);
|
|
green = RANGE( (ScaledY - (715 * v) - (344 * u)) / 1024, 0, 255);
|
|
blue = RANGE( (ScaledY + (1774 * u)) / 1024, 0, 255);
|
|
|
|
return (WORD) (((red & 0xf8) << 8) | ((green & 0xfc) << 3) | ((blue & 0xf8) >>3) );
|
|
}
|
|
|
|
|
|
#ifdef TOSHIBA
|
|
#ifdef COLOR_MODIFY
|
|
/*
|
|
* TOSHIBA Y.Kasai
|
|
* for Pistachio.
|
|
*
|
|
* Convert a YUV colour into a 15-bit RGB colour.
|
|
*
|
|
* The input Y is in the range 0..255; the input U and V components
|
|
* are in the same range 0..255. The conversion equations for this are
|
|
* (according to CCIR 601):
|
|
*
|
|
* R = 1.1644Y + 1.5976 V - 223.0089
|
|
* G = 1.1644Y - 0.8133 V - 0.3921 U + 135.6523
|
|
* B = 1.1644Y + 2.0184 U - 276.9814
|
|
*
|
|
* To avoid floating point, we scale all values by 1024.
|
|
*
|
|
* 1024R = 1192Y + 1635V - 228361
|
|
* 1024G = 1192Y - 833V - 402U + 138908
|
|
* 1024B = 1192Y + 2067U - 283629
|
|
*
|
|
*/
|
|
BYTE
|
|
TosYVToR(int y, int v)
|
|
{
|
|
int ScaledY = y * 1192;
|
|
int red;
|
|
|
|
red = RANGE((ScaledY + (1635 * v) - 228361) / 1024, 0, 255);
|
|
|
|
return (BYTE) (red);
|
|
}
|
|
|
|
|
|
BYTE
|
|
TosYUToB(int y, int u)
|
|
{
|
|
int ScaledY = y * 1192;
|
|
int blue;
|
|
|
|
blue = RANGE( (ScaledY + (2067 * u) - 283629) / 1024, 0, 255);
|
|
|
|
return (BYTE) (blue);
|
|
}
|
|
|
|
#else //COLOR_MODIFY
|
|
/*
|
|
* TOSHIBA Y.Kasai
|
|
* for Pistachio.
|
|
*
|
|
* Convert a YUV colour into a 15-bit RGB colour.
|
|
*
|
|
* The input Y is in the range 0..255; the input U and V components
|
|
* are in the same range 0..255. The conversion equations for this are
|
|
* (according to CCIR 601):
|
|
*
|
|
* R = 1.1644Y + 1.5976 V - 223.0089
|
|
* G = 1.1644Y - 0.8133 V - 0.3921 U + 135.6523
|
|
* B = 1.1644Y + 2.0184 U - 276.9814
|
|
*
|
|
* To avoid floating point, we scale all values by 1024.
|
|
*
|
|
* 1024R = 1192Y + 1635V - 228361
|
|
* 1024G = 1192Y - 833V - 402U + 138908
|
|
* 1024B = 1192Y + 2067U - 283629
|
|
*
|
|
* The resulting RGB values are in the range 0..255: we truncate these to
|
|
* 5 bits each. and return a WORD containing 5-bits each for R, G and B
|
|
* with bit 15 set to 0.
|
|
*/
|
|
WORD
|
|
TosYUVToRGB555(int y, int u, int v)
|
|
{
|
|
int ScaledY = y * 1192;
|
|
int red, green, blue;
|
|
|
|
red = RANGE((ScaledY + (1635 * v) - 228361) / 1024, 0, 255);
|
|
green = RANGE( (ScaledY - (833 * v) - (402 * u) + 138908) / 1024, 0, 255);
|
|
blue = RANGE( (ScaledY + (2067 * u) - 283629) / 1024, 0, 255);
|
|
|
|
return (WORD) (((red & 0xf8) << 7) | ((green & 0xf8) << 2) | ((blue & 0xf8) >>3) );
|
|
}
|
|
|
|
|
|
// same as above but converts to RGB565 instead
|
|
WORD
|
|
TosYUVToRGB565(int y, int u, int v)
|
|
{
|
|
int ScaledY = y * 1192;
|
|
int red, green, blue;
|
|
|
|
red = RANGE((ScaledY + (1635 * v) - 228361) / 1024, 0, 255);
|
|
green = RANGE( (ScaledY - (833 * v) - (402 * u) + 138908) / 1024, 0, 255);
|
|
blue = RANGE( (ScaledY + (2067 * u) - 283629) / 1024, 0, 255);
|
|
|
|
return (WORD) (((red & 0xf8) << 8) | ((green & 0xfc) << 3) | ((blue & 0xf8) >>3) );
|
|
}
|
|
#endif//COLOR_MODIFY
|
|
#endif//TOSHIBA
|
|
|
|
|
|
|
|
/* --- YUV 4:1:1 support ------------------------------------------ */
|
|
|
|
|
|
|
|
|
|
/*
|
|
* the input data is in YUV411 format. There is one 7 bit Luma sample
|
|
* per pixel, and 1 each 7-bit U and V sample averaged over 4 pixels,
|
|
* in the following layout:
|
|
*
|
|
* 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
|
|
* Word 0 u6 u5 v6 v5 y6 y5 y4 y3 y2 y1 y0
|
|
*
|
|
* Word 1 u4 u3 v4 v3 y6 y5 y4 y3 y2 y1 y0
|
|
*
|
|
* Word 2 u2 u1 v2 v1 y6 y5 y4 y3 y2 y1 y0
|
|
*
|
|
* Word 3 u0 v0 y6 y5 y4 y3 y2 y1 y0
|
|
*
|
|
* The 7-bit y values are unsigned (0..127), whereas the 7-bit
|
|
* u and V values are signed (-64..+63).
|
|
*
|
|
*
|
|
* For RGB: we truncate the YUV into a 15-bit format and use a prepared
|
|
* lookup table to convert the 15-bit YUV into a 15- or 16-bit RGB value.
|
|
*
|
|
* The (64 kbyte) rgb555 lookup table is built by BuildYUVToRGB555.
|
|
*
|
|
*/
|
|
|
|
|
|
/*
|
|
* the YUV xlate tables use 5-bits per component with y in the ms bits, and
|
|
* v in the ls bits. To convert from the above layout, look up the nibbles
|
|
* containing the chroma bits in these tables and or together the result to
|
|
* get a word with a 5-bit V component in bits 0..4, and a 5-bit
|
|
* U component in bits 5..9. Note you only need three lookups since
|
|
* we discard chroma bits 0 and 1.
|
|
*/
|
|
WORD ChromaBits65[] = {
|
|
0x000, 0x008, 0x010, 0x018,
|
|
0x100, 0x108, 0x110, 0x118,
|
|
0x200, 0x208, 0x210, 0x218,
|
|
0x300, 0x308, 0x310, 0x318
|
|
};
|
|
|
|
WORD ChromaBits43[] = {
|
|
0x000, 0x002, 0x004, 0x006,
|
|
0x040, 0x042, 0x044, 0x046,
|
|
0x080, 0x082, 0x084, 0x086,
|
|
0x0c0, 0x0c2, 0x0c4, 0x0c6
|
|
};
|
|
|
|
WORD ChromaBits2[] = {
|
|
0x000, 0x000, 0x001, 0x001,
|
|
0x000, 0x000, 0x001, 0x001,
|
|
0x020, 0x020, 0x021, 0x021,
|
|
0x020, 0x020, 0x021, 0x021
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
* build yuv411->RGB555 xlate table
|
|
*/
|
|
LPVOID BuildYUVToRGB555(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = NULL;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024))
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB555 = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
/*
|
|
* the YUVtoRGB55 conversion function takes values 0..255 for y,
|
|
* and -128..+127 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
* Remember the cast to ensure sign-extension of these (8-bit) values -
|
|
* and don't assume that chars are signed (they're not on MIPS).
|
|
*/
|
|
*pRGB555++ = YUVToRGB555(
|
|
(w & 0x7c00) >> 7,
|
|
(signed char) ((w & 0x3e0) >> 2),
|
|
(signed char) ((w & 0x1f) << 3)
|
|
);
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
}
|
|
|
|
/*
|
|
* build yuv411->RGB565 xlate table
|
|
*/
|
|
LPVOID BuildYUVToRGB565(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024))
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
/*
|
|
* the YUVtoRGB conversion function takes values 0..255 for y,
|
|
* and -128..+127 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
* Remember the cast to ensure sign-extension of these (8-bit) values -
|
|
* and don't assume that chars are signed (they're not on MIPS).
|
|
*/
|
|
*pRGB++ = YUVToRGB565(
|
|
(w & 0x7c00) >> 7,
|
|
(signed char) ((w & 0x3e0) >> 2),
|
|
(signed char) ((w & 0x1f) << 3)
|
|
);
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
* translate one frame from yuv411 to 15/16 bit rgb.
|
|
*
|
|
* The YUV data is spread over 4 16-bit pixels in the format described
|
|
* above. Pick out 4 pixels at a time, truncate them to 15-bit yuv,
|
|
* lookup to translate to 15 or 16-bit rgb (depending on the lookup table
|
|
* and write out.
|
|
*
|
|
* Flip vertically into correct dib format during conversion.
|
|
*/
|
|
VOID
|
|
YUV411ToRGB(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int i, j;
|
|
DWORD Luma01, Luma23;
|
|
DWORD Chroma;
|
|
int Height, Width;
|
|
int WidthBytes;
|
|
PWORD pXlate;
|
|
PWORD pDst;
|
|
PDWORD pSrc;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the source to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pSrc = (PDWORD) ( (PUCHAR) lpInput + ((Height - 1) * WidthBytes));
|
|
pDst = (PWORD) lpOutput;
|
|
|
|
/*
|
|
* calculate the amount to adjust source by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = (WidthBytes * 2) / sizeof(DWORD);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < Height; i++) {
|
|
|
|
/* loop copying four pixels at a time */
|
|
for (j = 0; j < Width; j += 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
/* get luma for first 2 pixels + higher chroma bits */
|
|
Luma01 = *pSrc++;
|
|
|
|
|
|
/* pick out u,v components using lookup table.
|
|
* u and v will be the bottom 10 bits of each pixel, so
|
|
* convert to this layout
|
|
*/
|
|
Chroma = ChromaBits65[(Luma01 >> 12) & 0xf] |
|
|
ChromaBits43[ (Luma01 >> 28) & 0xf ];
|
|
|
|
/* next two pixels + lower chroma bits */
|
|
Luma23 = *pSrc++;
|
|
|
|
/* pickup u and v bits 2 - ignore bits 1, 0 since
|
|
* we only use 5-bits per component for conversion
|
|
*/
|
|
Chroma |= ChromaBits2[ ( Luma23 >> 12) & 0xf];
|
|
|
|
/*
|
|
* combine luma for pix 0 with common chroma bits to
|
|
* get 15-bit yuv, then lookup to convert to
|
|
* rgb and store.
|
|
*/
|
|
*pDst++ = pXlate[ ((Luma01 & 0xf8) << 7) | Chroma];
|
|
*pDst++ = pXlate[ ((Luma01 & 0xf80000) >> 9) | Chroma];
|
|
*pDst++ = pXlate[ ((Luma23 & 0xf8) << 7) | Chroma];
|
|
*pDst++ = pXlate[ ((Luma23 & 0xf80000) >> 9) | Chroma];
|
|
|
|
} // loop per 4 pixels
|
|
|
|
/* move source pointer back to next line */
|
|
pSrc -= RowInc;
|
|
} // loop per row
|
|
}
|
|
|
|
|
|
/* YUV 4:2:2 support ------------------------------------------ */
|
|
|
|
/*
|
|
* The captured data is in YUV 4:2:2, 8-bits per sample.
|
|
* The data is laid out in alternating Y-U-Y-V-Y-U-Y-V format. Thus
|
|
* every DWORD contains two complete pixels, in the
|
|
* form (msb..lsb) V..Y1..U..Y0
|
|
* All 3 components (y, u and v) are all unsigned 8-bit values in the range
|
|
* 16..235.
|
|
*
|
|
* We have to double scan lines for >= 480 line formats since
|
|
* the hardware only captured one field maximum.
|
|
*
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
* build a translation table to translate between YUV and RGB555.
|
|
*
|
|
* This builds a lookup table with 32k 1-word entries: truncate the YUV
|
|
* to 15bits (5-5-5) and look-up in this xlate table to produce the
|
|
* 15-bit rgb value.
|
|
*/
|
|
LPVOID BuildYUV422ToRGB555(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024))
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB555 = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
/*
|
|
* the YUVtoRGB55 conversion function takes values 0..255 for y,
|
|
* and -128..+127 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
* Subtract 128 from u and v to shift from 0..255 to -128..+127
|
|
*/
|
|
*pRGB555++ = YUVToRGB555(
|
|
(w & 0x7c00) >> 7,
|
|
((w & 0x3e0) >> 2) - 128,
|
|
((w & 0x1f) << 3) - 128
|
|
);
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
|
|
|
|
}
|
|
|
|
/*
|
|
* build a translation table to translate between YUV and RGB 5-6-5
|
|
*
|
|
* This builds a lookup table with 32k 1-word entries: truncate the YUV
|
|
* to 15bits (5-5-5) and look-up in this xlate table to produce the
|
|
* 16-bit rgb value.
|
|
*/
|
|
LPVOID BuildYUV422ToRGB565(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024))
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
/*
|
|
* the YUVtoRGB conversion function takes values 0..255 for y,
|
|
* and -128..+127 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
* Subtract 128 from u and v to shift from 0..255 to -128..+127
|
|
*/
|
|
*pRGB++ = YUVToRGB565(
|
|
(w & 0x7c00) >> 7,
|
|
((w & 0x3e0) >> 2) - 128,
|
|
((w & 0x1f) << 3) - 128
|
|
);
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
|
|
|
|
}
|
|
|
|
/*
|
|
* translate YUV 4:2:2 into 16-bit RGB using a lookup table. Flip vertically
|
|
* into DIB format during processing. Double scanlines for formats of
|
|
* 480 lines or greater. Produces 565 or 555 format RGB depending on the
|
|
* xlate table.
|
|
*/
|
|
VOID
|
|
YUV422ToRGB(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pSrc, pDst;
|
|
int Height, Width;
|
|
PWORD pXlate;
|
|
int InputHeight;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pSrc = (PDWORD) lpInput;
|
|
|
|
|
|
/*
|
|
* do we need to duplicate scans to fill the destination ?
|
|
*/
|
|
if (Height >= 480) {
|
|
bDuplicate = TRUE;
|
|
|
|
/*
|
|
* we need to skip one line each time we copy a line
|
|
*/
|
|
RowInc = WidthBytes * 2 + (Width * 2);
|
|
|
|
InputHeight = Height/2;
|
|
|
|
} else {
|
|
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
}
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
|
|
|
|
/* loop copying each scanline */
|
|
for (i = InputHeight; i > 0; i--) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 2) {
|
|
|
|
/*
|
|
* get two pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwPixel = *pSrc++;
|
|
|
|
|
|
/*
|
|
* dwPixel now has two pixels, in this layout (MSB..LSB):
|
|
*
|
|
* V Y1 U Y0
|
|
*
|
|
* convert to 2 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* get common u and v components to lower 10 bits */
|
|
uv55 = ((dwPixel & 0xf8000000) >> 27) |
|
|
((dwPixel & 0x0000f800) >> 6);
|
|
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwPixel = pXlate[ ((dwPixel & 0xf8) << 7) | uv55 ] |
|
|
(pXlate[((dwPixel & 0xf80000) >> 9) | uv55 ] << 16);
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
|
|
} // loop per 2 pixels
|
|
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
|
|
|
|
|
|
if (bDuplicate) {
|
|
|
|
PBYTE pbDst;
|
|
|
|
/*
|
|
* Note that since we started at the last line, and didn't duplicate,
|
|
* we placed data in lines 1, 3, 5 etc that needs to be copied
|
|
* to lines 0, 2, 4 etc.
|
|
*/
|
|
for (i = 0, pbDst = lpOutput; i < (int) Height; i+= 2) {
|
|
|
|
|
|
/*
|
|
* duplicate the scan line. We point at the first of the
|
|
* two lines - the data is in the second of the
|
|
* two lines.
|
|
*/
|
|
RtlCopyMemory(pbDst, pbDst + WidthBytes, WidthBytes);
|
|
|
|
/* skip this pair to get to the next line to be converted */
|
|
pbDst += WidthBytes * 2;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
#ifdef TOSHIBA
|
|
#ifdef COLOR_MODIFY
|
|
/* YUV12 support ------------------------------------------ */
|
|
|
|
/*
|
|
* TOSHIBA Y.Kasai
|
|
* for Pistachio
|
|
*
|
|
* The captured data is in YUV12 , 8-bits per.
|
|
* The data is separated each Y,U,V segment.
|
|
* Data format is folow sequence:
|
|
* Y0,Y1,Y2.......Yn,U0,U1,U2.....U(n/4),V0,V1,V2....V(n/4)
|
|
*
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
* build a translation table to translate between YUV and RGB555.
|
|
*
|
|
* This builds a lookup table with 32k 1-word entries: truncate the YUV
|
|
* to 15bits (5-5-5) and look-up in this xlate table to produce the
|
|
* 15-bit rgb value.
|
|
*/
|
|
LPVOID BuildYUVToRB(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 64k 2-coloer (R, B) entries
|
|
*/
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 64 * 1024) )
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
LPBYTE pRB = (LPBYTE)pXlate;
|
|
ULONG w;
|
|
|
|
for (w = 0; w < 64*1024; w++) {
|
|
*pRB++ = TosYVToR( (w & 0xff00) >> 8, ((w & 0xff)) );
|
|
}
|
|
|
|
for (w = 0; w < 64*1024; w++) {
|
|
*pRB++ = TosYUToB( (w & 0xff00) >> 8, ((w & 0xff)) );
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
}
|
|
|
|
#else //COLOR_MODIFY
|
|
/* YUV12 support ------------------------------------------ */
|
|
|
|
/*
|
|
* TOSHIBA Y.Kasai
|
|
* for Pistachio
|
|
*
|
|
* The captured data is in YUV12 , 8-bits per.
|
|
* The data is separated each Y,U,V segment.
|
|
* Data format is folow sequence:
|
|
* Y0,Y1,Y2.......Yn,U0,U1,U2.....U(n/4),V0,V1,V2....V(n/4)
|
|
*
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
* build a translation table to translate between YUV and RGB555.
|
|
*
|
|
* This builds a lookup table with 32k 1-word entries: truncate the YUV
|
|
* to 15bits (5-5-5) and look-up in this xlate table to produce the
|
|
* 15-bit rgb value.
|
|
*/
|
|
LPVOID BuildYUV12ToRGB555(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
// LPWORD pRGB555;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024) )
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB555 = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
/*
|
|
* the YUVtoRGB55 conversion function takes values 0..255 for y,
|
|
* and 0..255 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
*/
|
|
*pRGB555++ = TosYUVToRGB555(
|
|
(w & 0x7c00) >> 7,
|
|
((w & 0x3e0) >> 2),
|
|
((w & 0x1f) << 3)
|
|
);
|
|
}
|
|
}
|
|
return(pXlate);
|
|
}
|
|
|
|
/*
|
|
* build a translation table to translate between YUV and RGB 5-6-5
|
|
*
|
|
* This builds a lookup table with 32k 1-word entries: truncate the YUV
|
|
* to 15bits (5-5-5) and look-up in this xlate table to produce the
|
|
* 16-bit rgb value.
|
|
*/
|
|
LPVOID BuildYUV12ToRGB565(PINSTINFO pinst)
|
|
{
|
|
HGLOBAL hMem = 0;
|
|
LPVOID pXlate = NULL;
|
|
|
|
if (pinst->pXlate != NULL) {
|
|
return(pinst->pXlate);
|
|
}
|
|
|
|
/*
|
|
* allocate a table big enough for 32k 2-byte entries
|
|
*/
|
|
|
|
if ( ( hMem = GlobalAlloc(GPTR, 2 * 32 * 1024) )
|
|
&& ( pXlate = GlobalLock( hMem ) ) )
|
|
{
|
|
WORD w;
|
|
LPWORD pRGB = (LPWORD)pXlate;
|
|
|
|
/*
|
|
* build a 15-bit yuv lookup table by stepping through each entry,
|
|
* converting the yuv index to rgb and storing at that index. The index
|
|
* to this table is a 15-bit value with the y component in bits 14..10,
|
|
* u in bits 9..5 and v in bits 4..0. Note that the y component is unsigned,
|
|
* whereas the u and v components are signed.
|
|
*/
|
|
for (w = 0; w < 32*1024; w++) {
|
|
|
|
/*
|
|
* the YUVtoRGB conversion function takes values 0..255 for y,
|
|
* and 0.255 for u and v. Pick out the relevant bits of the
|
|
* index for this cell, and shift to get values in this range.
|
|
*/
|
|
*pRGB++ = TosYUVToRGB565(
|
|
(w & 0x7c00) >> 7,
|
|
((w & 0x3e0) >> 2),
|
|
((w & 0x1f) << 3)
|
|
);
|
|
}
|
|
}
|
|
|
|
return(pXlate);
|
|
}
|
|
#endif//COLOR_MODIFY
|
|
|
|
/*
|
|
* translate YUV12 into 16-bit RGB using a lookup table. Flip vertically
|
|
* into DIB format during processing. Double scanlines for formats of
|
|
* 240 lines or greater. Produces 565 or 555 format RGB depending on the
|
|
* xlate table.
|
|
*/
|
|
#ifdef COLOR_MODIFY
|
|
VOID
|
|
YUV12ToRGB24(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PBYTE pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PWORD pUSrc, pVSrc;
|
|
WORD wUPixel, wVPixel;
|
|
WORD wUPTemp, wVPTemp;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*3; // size of (input and output) line
|
|
pXlate = (PBYTE)pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PBYTE) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
pUSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width);
|
|
pVSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width + Height * Width / 4);
|
|
|
|
RowInc = WidthBytes + (Width * 3);
|
|
|
|
UVRowInc = Width / 2;
|
|
UVRowInc /= sizeof(WORD);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
wUPixel = *pUSrc++;
|
|
wVPixel = *pVSrc++;
|
|
|
|
wVPTemp = wVPixel & 0xff;
|
|
wUPTemp = wUPixel & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has two pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V1 V0
|
|
* U1 U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 8 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
wVPTemp = (wVPixel >> 8) & 0xff;
|
|
wUPTemp = (wUPixel >> 8) & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if (!(i & 1))
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
|
|
VOID
|
|
YUV12ToRGB565(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PDWORD pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PWORD pUSrc, pVSrc;
|
|
WORD wUPixel, wVPixel;
|
|
WORD wUPTemp, wVPTemp;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = (PBYTE)pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
pUSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width);
|
|
pVSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width + Height * Width / 4);
|
|
|
|
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
UVRowInc = Width / 2;
|
|
UVRowInc /= sizeof(WORD);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
wUPixel = *pUSrc++;
|
|
wVPixel = *pVSrc++;
|
|
|
|
wVPTemp = wVPixel & 0xff;
|
|
wUPTemp = wUPixel & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has two pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V1 V0
|
|
* U1 U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 8 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
|
|
dwPixel = (ubR & 0xf8) << 8 | (ubG & 0xfc) << 3 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 24 | (ubG & 0xfc) << 19 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
wVPTemp = (wVPixel >> 8) & 0xff;
|
|
wUPTemp = (wUPixel >> 8) & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel = (ubR & 0xf8) << 8 | (ubG & 0xfc) << 3 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 24 | (ubG & 0xfc) << 19 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if (!(i & 1))
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
|
|
VOID
|
|
YUV12ToRGB555(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PDWORD pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PWORD pUSrc, pVSrc;
|
|
WORD wUPixel, wVPixel;
|
|
WORD wUPTemp, wVPTemp;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = (PBYTE)pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
pUSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width);
|
|
pVSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width + Height * Width / 4);
|
|
|
|
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
UVRowInc = Width / 2;
|
|
UVRowInc /= sizeof(WORD);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
wUPixel = *pUSrc++;
|
|
wVPixel = *pVSrc++;
|
|
|
|
wVPTemp = wVPixel & 0xff;
|
|
wUPTemp = wUPixel & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has two pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V1 V0
|
|
* U1 U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 8 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
|
|
dwPixel = (ubR & 0xf8) << 7 | (ubG & 0xf8) << 2 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 23 | (ubG & 0xf8) << 18 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
wVPTemp = (wVPixel >> 8) & 0xff;
|
|
wUPTemp = (wUPixel >> 8) & 0xff;
|
|
dwParam = (833 * wVPTemp) + (402 * wUPTemp) - 138908;
|
|
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel = (ubR & 0xf8) << 7 | (ubG & 0xf8) << 2 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | wVPTemp];
|
|
ubB = pXlate[(dwTemp | wUPTemp) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 23 | (ubG & 0xf8) << 18 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if (!(i & 1))
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
#else //COLOR_MODIFY
|
|
VOID
|
|
YUV12ToRGB(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc, pDst;
|
|
PWORD pUSrc, pVSrc;
|
|
WORD wUPixel, wVPixel;
|
|
int Height, Width;
|
|
PWORD pXlate;
|
|
int InputHeight;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
#if 1
|
|
pUSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width);
|
|
pVSrc = (PWORD) ( (LPBYTE)lpInput + Height * Width + Height * Width / 4);
|
|
#else
|
|
pUSrc = (PWORD) lpInput + Height * Width;
|
|
pVSrc = (PWORD) lpInput + Height * Width + Height * Width / 4;
|
|
#endif
|
|
|
|
|
|
#if 1
|
|
RowInc = WidthBytes + (Width * 2);
|
|
#else
|
|
/*
|
|
* do we need to duplicate scans to fill the destination ?
|
|
*/
|
|
if (Height >= 240) {
|
|
bDuplicate = TRUE;
|
|
|
|
/*
|
|
* we need to skip one line each time we copy a line
|
|
*/
|
|
RowInc = WidthBytes * 2 + (Width * 2);
|
|
|
|
InputHeight = Height/2;
|
|
|
|
} else {
|
|
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
}
|
|
#endif
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
UVRowInc = Width / 2;
|
|
UVRowInc /= sizeof(WORD);
|
|
|
|
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
wUPixel = *pUSrc++;
|
|
wVPixel = *pVSrc++;
|
|
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has two pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V1 V0
|
|
* U1 U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* get common u0 and v0 components to lower 10 bits */
|
|
uv55 = ((wUPixel & 0xf8) << 2) |
|
|
((wVPixel & 0xf8) >> 3);
|
|
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwPixel = pXlate[ ((dwYPixel & 0xf8) << 7) | uv55 ] |
|
|
(pXlate[((dwYPixel & 0xf800) >> 1) | uv55 ] << 16);
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
/* get common u1 and v1 components to lower 10 bits */
|
|
uv55 = ((wUPixel & 0xf800) >> 6) |
|
|
((wVPixel & 0xf800) >> 11);
|
|
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwPixel = pXlate[ ((dwYPixel & 0xf80000) >> 9) | uv55 ] |
|
|
(pXlate[((dwYPixel & 0xf8000000) >> 17) | uv55 ] << 16);
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if (!(i & 1))
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
|
|
|
|
#if 0 // Pistachio is not support Interlace mode!!
|
|
|
|
if (bDuplicate) {
|
|
|
|
PBYTE pbDst;
|
|
|
|
/*
|
|
* Note that since we started at the last line, and didn't duplicate,
|
|
* we placed data in lines 1, 3, 5 etc that needs to be copied
|
|
* to lines 0, 2, 4 etc.
|
|
*/
|
|
for (i = 0, pbDst = lpOutput; i < (int) Height; i+= 2) {
|
|
|
|
|
|
/*
|
|
* duplicate the scan line. We point at the first of the
|
|
* two lines - the data is in the second of the
|
|
* two lines.
|
|
*/
|
|
RtlCopyMemory(pbDst, pbDst + WidthBytes, WidthBytes);
|
|
|
|
/* skip this pair to get to the next line to be converted */
|
|
pbDst += WidthBytes * 2;
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
#endif//COLOR_MODIFY
|
|
|
|
|
|
|
|
/* YUV9 Support ------------------------------------------ */
|
|
|
|
/*
|
|
* TOSHIBA Y.Kasai
|
|
* for Pistachio
|
|
*
|
|
* The captured data is in YUV9 .
|
|
* The data is separated each Y,U,V segment.
|
|
* Data format is folow sequence:
|
|
* Y0,Y1,Y2.......Yn,V0,V1,V2....V(n/16),U0,U1,U2.....U(n/16)
|
|
*
|
|
*/
|
|
|
|
|
|
/*
|
|
* translate YUV9 into 16-bit RGB using a lookup table. Flip vertically
|
|
* into DIB format during processing.
|
|
* Produces 565 or 555 format RGB depending on the
|
|
* xlate table.
|
|
*/
|
|
#ifdef COLOR_MODIFY
|
|
VOID
|
|
YUV9ToRGB24(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PBYTE pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PBYTE pUSrc, pVSrc;
|
|
BYTE bUPixel, bVPixel;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*3; // size of (input and output) line
|
|
pXlate = (PBYTE)pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PBYTE) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
|
|
pVSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width);
|
|
pUSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width + Height * Width / 16);
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 3);
|
|
|
|
UVRowInc = Width / 4;
|
|
UVRowInc /= sizeof(BYTE);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
bUPixel = *pUSrc++;
|
|
bVPixel = *pVSrc++;
|
|
|
|
dwParam = (833 * bVPixel) + (402 * bUPixel) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has four pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V0
|
|
* U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE((((dwTemp >> 8) & 0xff) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
*pDst++ = ubB;
|
|
*pDst++ = ubG;
|
|
*pDst++ = ubR;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if ((i & 0x3) != 0x03)
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
|
|
VOID
|
|
YUV9ToRGB565(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PDWORD pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PBYTE pUSrc, pVSrc;
|
|
BYTE bUPixel, bVPixel;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = (PBYTE)pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
|
|
pVSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width);
|
|
pUSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width + Height * Width / 16);
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
|
|
UVRowInc = Width / 4;
|
|
UVRowInc /= sizeof(BYTE);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
bUPixel = *pUSrc++;
|
|
bVPixel = *pVSrc++;
|
|
|
|
dwParam = (833 * bVPixel) + (402 * bUPixel) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has four pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V0
|
|
* U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
|
|
dwPixel = (ubR & 0xf8) << 8 | (ubG & 0xfc) << 3 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 24 | (ubG & 0xfc) << 19 | (ubB & 0xf8) << 13;
|
|
|
|
*pDst++ = dwPixel;
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel = (ubR & 0xf8) << 8 | (ubG & 0xfc) << 3 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE((((dwTemp >> 8) & 0xff) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 24 | (ubG & 0xfc) << 19 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if ((i & 0x3) != 0x03)
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
|
|
VOID
|
|
YUV9ToRGB555(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int dwParam, dwTemp;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc;
|
|
volatile PDWORD pDst; // '98-12-08 Add volatile attr. for Rep.253570
|
|
PBYTE pUSrc, pVSrc;
|
|
BYTE bUPixel, bVPixel;
|
|
int Height, Width;
|
|
PBYTE pXlate;
|
|
int InputHeight;
|
|
BYTE ubR, ubG, ubB;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
|
|
pVSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width);
|
|
pUSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width + Height * Width / 16);
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
|
|
UVRowInc = Width / 4;
|
|
UVRowInc /= sizeof(BYTE);
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
bUPixel = *pUSrc++;
|
|
bVPixel = *pVSrc++;
|
|
|
|
dwParam = (833 * bVPixel) + (402 * bUPixel) - 138908;
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has four pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V0
|
|
* U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = dwYPixel & 0xff;
|
|
ubG = (BYTE)RANGE((dwTemp * 1192 - dwParam) / 1024, 0, 255);
|
|
dwTemp <<= 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
|
|
dwPixel = (ubR & 0xf8) << 7 | (ubG & 0xf8) << 2 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = dwYPixel & 0xff00;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 23 | (ubG & 0xf8) << 18 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwTemp = (dwYPixel & 0xff0000) >> 8;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE(((dwTemp >> 8) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel = (ubR & 0xf8) << 7 | (ubG & 0xf8) << 2 | (ubB & 0xf8) >> 3;
|
|
|
|
// next pixel
|
|
dwTemp = (dwYPixel & 0xff000000) >> 16;
|
|
ubR = pXlate[ dwTemp | bVPixel];
|
|
ubB = pXlate[(dwTemp | bUPixel) + 65536];
|
|
ubG = (BYTE)RANGE((((dwTemp >> 8) & 0xff) * 1192 - dwParam) / 1024, 0, 255);
|
|
|
|
dwPixel |= (ubR & 0xf8) << 23 | (ubG & 0xf8) << 18 | (ubB & 0xf8) << 13;
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if ((i & 0x3) != 0x03)
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
}
|
|
|
|
#else //COLOR_MODIFY
|
|
VOID
|
|
YUV9ToRGB(
|
|
PINSTINFO pinst,
|
|
LPBITMAPINFOHEADER lpbiInput,
|
|
LPVOID lpInput,
|
|
LPBITMAPINFOHEADER lpbiOutput,
|
|
LPVOID lpOutput
|
|
)
|
|
{
|
|
int RowInc;
|
|
int UVRowInc;
|
|
int i, j;
|
|
DWORD uv55, dwPixel, dwYPixel;
|
|
int WidthBytes; // width of one line in BYTES
|
|
BOOL bDuplicate = FALSE;
|
|
PDWORD pYSrc, pDst;
|
|
PBYTE pUSrc, pVSrc;
|
|
BYTE bUPixel, bVPixel;
|
|
int Height, Width;
|
|
PWORD pXlate;
|
|
int InputHeight;
|
|
|
|
|
|
Height = lpbiInput->biHeight;
|
|
InputHeight = Height;
|
|
Width = lpbiInput->biWidth;
|
|
WidthBytes = Width*2; // size of (input and output) line
|
|
pXlate = pinst->pXlate;
|
|
|
|
|
|
/*
|
|
* adjust the destination to point to the start of the last line,
|
|
* and work upwards (to flip vertically into DIB format)
|
|
*/
|
|
pDst = (PDWORD) ( (LPBYTE)lpOutput + (Height - 1) * WidthBytes );
|
|
pYSrc = (PDWORD) lpInput;
|
|
|
|
#if 1
|
|
pVSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width);
|
|
pUSrc = (PBYTE) ( (LPBYTE)lpInput + Height * Width + Height * Width / 16);
|
|
#else
|
|
pVSrc = (PBYTE) lpInput + Height * Width;
|
|
pUSrc = (PBYTE) lpInput + Height * Width + Height * Width / 16;
|
|
#endif
|
|
|
|
|
|
|
|
/*
|
|
* calculate the amount to adjust pDst by at the end of one line
|
|
* of copying. At this point we are at the end of line N. We need
|
|
* to move to the start of line N-1.
|
|
*/
|
|
RowInc = WidthBytes + (Width * 2);
|
|
|
|
|
|
/* remember we are adding to a DWORD pointer */
|
|
RowInc /= sizeof(DWORD);
|
|
|
|
|
|
UVRowInc = Width / 4;
|
|
UVRowInc /= sizeof(BYTE);
|
|
|
|
|
|
|
|
/* loop copying each scanline */
|
|
for (i = 0; i < InputHeight; i++) {
|
|
|
|
/* loop copying two pixels at a time */
|
|
for (j = Width ; j > 0; j -= 4) {
|
|
|
|
/*
|
|
* get four pixels and convert to 15-bpp YUV
|
|
*/
|
|
|
|
dwYPixel = *pYSrc++;
|
|
bUPixel = *pUSrc++;
|
|
bVPixel = *pVSrc++;
|
|
|
|
|
|
/*
|
|
* dwY(U or V)Pixel now has four pixels, in this layout (MSB..LSB):
|
|
*
|
|
* Y3 Y2 Y1 Y0
|
|
* V0
|
|
* U0
|
|
*
|
|
* convert to 4 yuv555 words and lookup in xlate table
|
|
*/
|
|
|
|
/* get common u0 and v0 components to lower 10 bits */
|
|
uv55 = ((bUPixel & 0xf8) << 2) |
|
|
((bVPixel & 0xf8) >> 3);
|
|
|
|
|
|
/* build each yuv-555 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwPixel = pXlate[ ((dwYPixel & 0xf8) << 7) | uv55 ] |
|
|
(pXlate[((dwYPixel & 0xf800) >> 1) | uv55 ] << 16);
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
|
|
/* build each yuv-655 value by truncating
|
|
* y to 5 bits and adding the common u and v bits,
|
|
* look up to convert to rgb, and combine two pixels
|
|
* into one dword
|
|
*/
|
|
dwPixel = pXlate[ ((dwYPixel & 0xf80000) >> 9) | uv55 ] |
|
|
(pXlate[((dwYPixel & 0xf8000000) >> 17) | uv55 ] << 16);
|
|
|
|
/* write two pixels to destination */
|
|
*pDst++ = dwPixel;
|
|
|
|
|
|
|
|
} // loop per 4 pixels
|
|
|
|
if ((i & 0x3) != 0x03)
|
|
{
|
|
pUSrc -= UVRowInc;
|
|
pVSrc -= UVRowInc;
|
|
}
|
|
|
|
/* move dest pointer back to next line */
|
|
pDst -= RowInc;
|
|
|
|
} // loop per row
|
|
|
|
}
|
|
#endif//COLOR_MODIFY
|
|
#endif//TOSHIBA
|
|
|
|
|
|
|
|
VOID FreeXlate(PINSTINFO pinst)
|
|
{
|
|
|
|
GlobalFree(GlobalHandle(pinst->pXlate));
|
|
|
|
pinst->pXlate = NULL;
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|