// Copyright (c) 2006-2009 Nokia Corporation and/or its subsidiary(-ies).

// All rights reserved.

// This component and the accompanying materials are made available

// under the terms of the License "Eclipse Public License v1.0"

// which accompanies this distribution, and is available

// at the URL "http://www.eclipse.org/legal/epl-v10.html".

//

// Initial Contributors:

// Nokia Corporation - initial contribution.

//

// Contributors:

//

// Description:

// e32test\multimedia\t_camera_display.cpp

// 

//

#include <e32test.h>

#include <e32svr.h>

#include <u32hal.h>

#include <videodriver.h>

#include "t_camera_display.h"

_LIT(KFrameSizeConfTitle,"Current frame size  :");

_LIT(KFrameSize, " %d x %d");

#define CLIP(a) if (a < 0) a = 0; else if (a > 255) a = 255;

/**

Constructor

*/

TCamDisplayHandler::TCamDisplayHandler()

	{}

/**

Initialise the display handler.

@return KErrNone if write was successful, otherwise one of the other system wide error codes.

*/

TInt TCamDisplayHandler::Init()

	{

	TScreenInfoV01 screenInfo;

	TPckg<TScreenInfoV01> screenInfoBuf(screenInfo);

	UserSvr::ScreenInfo(screenInfoBuf);

	iVideoAddress = (TUint8*) screenInfo.iScreenAddress;

	iScreenWidth = screenInfo.iScreenSize.iWidth;

	iScreenHeight = screenInfo.iScreenSize.iHeight;

	TPckgBuf<TVideoInfoV01> videoInfoBuf;

	UserSvr::HalFunction(EHalGroupDisplay, EDisplayHalCurrentModeInfo, &videoInfoBuf, NULL);

	iBitsPerPixel = videoInfoBuf().iBitsPerPixel;

	return(KErrNone);

	}

TInt TCamDisplayHandler::Min(TInt aA, TInt aB)

	{

	return (aA < aB) ? aA : aB;

	}

TInt TCamDisplayHandler::SetConfig(const SDevCamFrameSize& aSize,const SDevCamPixelFormat& aPixelFormat)

	{

	if (aPixelFormat.iPixelFormat==EUidPixelFormatYUV_422Interleaved || aPixelFormat.iPixelFormat==EUidPixelFormatRGB_565)

		iPixelFormat=aPixelFormat;

	else

		return(KErrArgument);

	iWidth = aSize.iWidth;

	iHeight = aSize.iHeight;

	return(KErrNone);

	}

/**

Post process a received image.

@return KErrNone if write was successful, otherwise one of the other system wide error codes.

*/

TInt TCamDisplayHandler::Process(TUint8* aImageBaseAddress)

	{

	switch (iPixelFormat.iPixelFormat)

		{

		case EUidPixelFormatYUV_422Interleaved:

			return(ProcessYUV422(aImageBaseAddress));

		case EUidPixelFormatRGB_565:

			return(ProcessRGB565(aImageBaseAddress));

		default:

			return(KErrNotSupported);

		}

	}

/**

Post process a received RGB565 image.

@return KErrNone if write was successful, otherwise one of the other system wide error codes.

*/

TInt TCamDisplayHandler::ProcessRGB565(TUint8* aImageBaseAddress)

	{

	TUint16* source = (TUint16*) aImageBaseAddress;

	TUint16 pixel;

	TInt sourceModulo, destModulo, width, height;

	TInt r = KErrNone;

	// Determine whether the screen or the picture to display is the widest, and calculate modulos

	// and clipping sizes appropriately

	if (iWidth < iScreenWidth)

		{

		width = iWidth;

		sourceModulo = 0;

		destModulo = (iScreenWidth - iWidth);

		}

	else

		{

		width = iScreenWidth;

		sourceModulo = (iWidth - iScreenWidth);

		destModulo = 0;

		}

	// Determine whether the screen or the picture to display is the highest

	height = (iHeight < iScreenHeight) ? iHeight : iScreenHeight;

	if (iBitsPerPixel == 16)

		{

		TUint16* dest = (TUint16*) iVideoAddress;

		// Loop around and copy the data directly onto the screen

		for (TInt line = 0; line < height; ++line)

			{

			for (TInt x = 0; x < width; ++x)

				{

				*dest++ = *source++;

				}

			source += sourceModulo;

			dest += destModulo;

			}

		}

	else if (iBitsPerPixel == 32)

		{

		TUint8* dest = iVideoAddress;

		destModulo *= 4;

		// Loop around and convert whatever part of the picture will fit onto the screen into BGRA,

		// writing it directly onto the screen

		for (TInt line = 0; line < height; ++line)

			{

			for (TInt x = 0; x < width; ++x)

				{

				pixel = *source++;

				*dest++= (TUint8) ((pixel & 0x001f) << 3);

				*dest++= (TUint8) ((pixel & 0x07e0) >> 3);

				*dest++= (TUint8) ((pixel & 0xf800) >> 8);

				*dest++ = 0xff;

				}

			source += sourceModulo;

			dest += destModulo;

			}

		}

	else

		{

		r = KErrNotSupported;

		}

	return r;

	}

/**

Post process a received YUV422 image.

@return KErrNone if write was successful, otherwise one of the other system wide error codes.

*/

TInt TCamDisplayHandler::ProcessYUV422(TUint8* aImageBaseAddress)

	{

	TUint16* dest16 = (TUint16*) iVideoAddress;

	TUint32* dest32 = (TUint32*) iVideoAddress;

	TUint8* source = aImageBaseAddress;

	TInt y, u, v, r, g, b, sourceModulo, destModulo, width, height;

	TInt retVal = KErrNone;

	// Determine whether the screen or the picture to display is the widest, and calculate modulos

	// and clipping sizes appropriately

	if (iWidth < iScreenWidth)

		{

		width = (iWidth / 2);

		sourceModulo = 0;

		destModulo = (iScreenWidth - iWidth);

		}

	else

		{

		width = (iScreenWidth / 2);

		sourceModulo = ((iWidth - iScreenWidth) * 2);

		destModulo = 0;

		}

	// Determine whether the screen or the picture to display is the highest

	height = (iHeight < iScreenHeight) ? iHeight : iScreenHeight;

	// Only 16 and 32 bits per pixel are supported.  It is also assumed that 16 bit will be RGB565 and

	// 32 bit will be BGRA.  You will need to add support for new formats if required

	if ((iBitsPerPixel == 16) || (iBitsPerPixel == 32))

		{

		// Loop around and convert whatever part of the picture will fit onto the screen into RGB565 or BGRA,

		// writing it directly onto the screen

		for (TInt line = 0; line < height; ++line)

			{

			for (TInt x = 0; x < width; ++x)

				{

				u = (source[0] - 128);

				v = (source[2] - 128);

				y = (source[3] - 16);

				r = ((298 * y + 409 * u) / 256);

				g = ((298 * y - 100 * v - 208 * u) / 256);

				b = ((298 * y + 516 * v) / 256);

				CLIP(r);

				CLIP(g);

				CLIP(b);

				if (iBitsPerPixel == 16)

					{

					*dest16++ = (TUint16) (((b & 0xf8) << 8) | ((g & 0xfc) << 3) | ((r & 0xf8) >> 3));

					}

				else

					{

					*dest32++ = (0xff000000 | (r << 16) | (g << 8) | b);

					}

				y = (source[1] - 16);

				r = ((298 * y + 409 * u) / 256);

				g = ((298 * y - 100 * v - 208 * u) / 256);

				b = ((298 * y + 516 * v) / 256);

				CLIP(r);

				CLIP(g);

				CLIP(b);

				if (iBitsPerPixel == 16)

					{

					*dest16++ = (TUint16) (((b & 0xf8) << 8) | ((g & 0xfc) << 3) | ((r & 0xf8) >> 3));

					}

				else

					{

					*dest32++ = (0xff000000 | (r << 16) | (g << 8) | b);

					}

				source += 4;

				}

			source += sourceModulo;

			dest16 += destModulo;

			dest32 += destModulo;

			}

		}

	else

		{

		retVal = KErrNotSupported;

		}

	return retVal;

	}

/**

Appends a string representing a pixel format UID onto a descriptor.

@param aBuffer		Reference to the descriptor into which to append the string.  It is up to the

					caller to ensure that this is large enough.

@param aPixelFormat	UID of the pixel format to be converted into a string.

*/

void AppendPixelFormat(TDes& aBuffer, TUidPixelFormat aPixelFormat)

	{

	if (aPixelFormat == EUidPixelFormatRGB_565)

		aBuffer.Append(KPixelFormatRGB_565);

	else if (aPixelFormat == EUidPixelFormatYUV_422Interleaved)

		aBuffer.Append(KPixelFormatYUV_422Interleaved);

	else if (aPixelFormat == EUidPixelFormatSpeedTaggedJPEG)

		aBuffer.Append(KPixelFormatSpeedTaggedJPEG);

	else if (aPixelFormat == EUidPixelFormatJPEG)

		aBuffer.Append(KPixelFormatJPEG);

	else

		aBuffer.Append(KPixelFormatUnknown);

	}

void PrintCamModes(TCameraCapsV02* aCaps,RTest& aTest)

	{

	TBuf<80> buf;

	// Display the supported capture modes

	buf.Zero();

	buf.Append(KCaptureModeCapsTitle);

	if (aCaps->iNumImagePixelFormats)

		buf.Append(KCaptureModeImage);

	if (aCaps->iNumVideoPixelFormats)

		buf.Append(KCaptureModeVideo);

	if (aCaps->iNumViewFinderPixelFormats)

		buf.Append(KCaptureModeViewFinder);

	buf.Append(_L("\r\n"));

	aTest.Printf(buf);

	// Display the supported video pixel formats

	TUint i;

	SDevCamPixelFormat* pixelFormat;

	if (aCaps->iNumImagePixelFormats)

		{

		buf.Zero();

		buf.Append(KPixelFormatCapsTitle);

		buf.Append(KCaptureModeImage);

		pixelFormat = (SDevCamPixelFormat*) (aCaps + 1);

		for (i = 0; i < aCaps->iNumImagePixelFormats; i++)

			{

			AppendPixelFormat(buf, pixelFormat->iPixelFormat);

			pixelFormat++;

			}

		buf.Append(_L("\r\n"));

		aTest.Printf(buf);

		}

	if (aCaps->iNumVideoPixelFormats)

		{

		buf.Zero();

		buf.Append(KPixelFormatCapsTitle);

		buf.Append(KCaptureModeVideo);

		pixelFormat = (SDevCamPixelFormat*) (aCaps + 1);

		for (i = aCaps->iNumImagePixelFormats; i < (aCaps->iNumImagePixelFormats + aCaps->iNumVideoPixelFormats); i++)

			{

			AppendPixelFormat(buf, pixelFormat->iPixelFormat);

			pixelFormat++;

			}

		buf.Append(_L("\r\n"));

		aTest.Printf(buf);

		}

	if (aCaps->iNumViewFinderPixelFormats)

		{

		buf.Zero();

		buf.Append(KPixelFormatCapsTitle);

		buf.Append(KCaptureModeViewFinder);

		pixelFormat = (SDevCamPixelFormat*) (aCaps + 1);

		i = aCaps->iNumImagePixelFormats + aCaps->iNumImagePixelFormats + 1;

		for (i = aCaps->iNumImagePixelFormats + aCaps->iNumVideoPixelFormats; i < (aCaps->iNumImagePixelFormats + aCaps->iNumVideoPixelFormats + aCaps->iNumViewFinderPixelFormats); i++)

			{

			AppendPixelFormat(buf, pixelFormat->iPixelFormat);

			pixelFormat++;

			}

		buf.Append(_L("\r\n"));

		aTest.Printf(buf);

		}

	}

void PrintCamConf(TCameraConfigV02& aConf,RTest& aTest)

	{

	TBuf<80> buf;

	// Display the current frame size

	buf.Zero();

	buf.Append(KFrameSizeConfTitle);

	buf.AppendFormat(KFrameSize, aConf.iFrameSize.iWidth, aConf.iFrameSize.iHeight);

	buf.Append(_L("\r\n"));

	aTest.Printf(buf);

	// Display the current pixel format

	buf.Zero();

	buf.Append(KPixelFormatConfTitle);

	AppendPixelFormat(buf, aConf.iPixelFormat.iPixelFormat);

	buf.Append(_L("\r\n"));

	aTest.Printf(buf);

	// Display the current frame rate

	buf.Zero();

	buf.Format(_L("Current frame rate  : %d fps\r\n"),aConf.iFrameRate);

	aTest.Printf(buf);

	}

void PrintBufferConf(TMmSharedChunkBufConfig& aBufConf,RTest& aTest)

	{

	TBuf<80> buf(0);

	SBufSpecList* tempSpec = aBufConf.iSpec;

	// Display the buffer configuration

	buf.Format(_L("Buffer Config       : NumBufs:%d Size:%xH\r\n"),aBufConf.iNumBuffers,aBufConf.iBufferSizeInBytes);

	aTest.Printf(buf);

	if (aBufConf.iFlags & KScFlagBufOffsetListInUse)

		{

		buf.Format(_L(" Offsets[%08xH,%08xH,%08xH,%08xH]\r\n"),tempSpec[0].iBufferOffset,tempSpec[1].iBufferOffset,tempSpec[2].iBufferOffset,tempSpec[3].iBufferOffset);

		aTest.Printf(buf);

		buf.Format(_L(" Offsets[%08xH,%08xH,%08xH,%08xH]\r\n"),tempSpec[4].iBufferOffset,tempSpec[5].iBufferOffset,tempSpec[6].iBufferOffset,tempSpec[7].iBufferOffset);

		aTest.Printf(buf);

		}

	}