camera.cpp

支持三星原产的S3C2413开发板

	{
	    //
	    // 1. Camera IO setup
	    //
		CamGpioInit();
	
		//
	    // 2. Camera Clock setup
	    //
		CamClockOn(TRUE);
		// 3. Camera i/f reset
	    CAM_IF_Reset();
	
/*		if (image_size == 1)
			CamInit(PQVGA_XSIZE, PQVGA_YSIZE, 112, 20, (U32)(g_PhysCodecAddr.LowPart));
		else if (image_size == 2)
			CamInit(PQVGA_XSIZE, PQVGA_YSIZE, 112, 20, (U32)(g_PhysCodecAddr.LowPart));
*/
		if (image_size == 1)
//			CamInit(VGA_XSIZE, VGA_YSIZE, 112, 20, (U32)(g_PhysCodecAddr.LowPart));
//			CamInit(QCIF_XSIZE, QCIF_YSIZE, 112, 40, (U32)(g_PhysCodecAddr.LowPart));
			CamInit(PREVIEW_X, PREVIEW_Y, 112, 40, (U32)(g_PhysCodecAddr.LowPart));
		else if (image_size == 2)
//			CamInit(VGA_XSIZE, VGA_YSIZE, 112, 20, (U32)(g_PhysCodecAddr.LowPart));
			CamInit(CIF_XSIZE, CIF_YSIZE, 112, 40, (U32)(g_PhysCodecAddr.LowPart));
	} 

	else 
	{
		//CamInterface_PowerUp();
	}		
} 

//-----------------------------------------------------------------------------
//-----------------------------------------------------------------------------
DWORD CIS_Read(DWORD hOpenContext, LPVOID pBuffer, DWORD Count)
{
	RETAILMSG(1,(TEXT("CAMERA: CIS_Read\r\n")));
	return TRUE;
} 

//-----------------------------------------------------------------------------
//-----------------------------------------------------------------------------
DWORD CIS_Seek(DWORD hOpenContext, long Amount, DWORD Type)
{
	RETAILMSG(1,(TEXT("CAMERA: CIS_Seek\r\n")));
	return 0;
} 

//-----------------------------------------------------------------------------
//-----------------------------------------------------------------------------
DWORD CIS_Write(DWORD hOpenContext, LPCVOID pSourceBytes, DWORD NumberOfBytes)
{
	RETAILMSG(1,(TEXT("CAMERA: CIS_Write\r\n")));
	return 0;
}

// for MPEG4
void Copy_Cam_Image(U8 *pBufOut, U32 size_x, U32 size_y, U8 port)
{
	U8 *buffer_y, *buffer_cb, *buffer_cr;
	U32 Y_size, C_size, P_size;
	int temp;
	U8 *pImage;
	static unsigned int frame_timestamp_prev = GetTickCount();
	static int frame_bank_prev = -1;
	YUVINFO yuvinfo;

	RETAILMSG(MSG_EN_1,(_T("Copy_Cam_Image\r\n")));

	//s2413IOP->GPFDAT &= ~(1<<6);	

	pImage = pBufOut;

	if (image_size == 1) // QCIF	
		Y_size = QCIF_XSIZE*QCIF_YSIZE;
	else if (image_size == 2) // CIF
		Y_size = CIF_XSIZE*CIF_YSIZE;
			
	C_size = Y_size/4;	
	P_size = Y_size + C_size*2;

	{
		temp = (pCIS->pCAMRegs->CICOSTATUS>>26)&3;
		temp = (temp + 2) % 4;

		RETAILMSG(MSG_EN_1,(_T("Copy_Cam_Image %d\r\n"), temp));

		switch (temp)
		{
		case 0:
			buffer_y = (U8 *)pCIS->pCAMRegs->CICOYSA1;
			buffer_cb = (U8 *)pCIS->pCAMRegs->CICOCBSA1;
			buffer_cr = (U8 *)pCIS->pCAMRegs->CICOCRSA1;
			break;
		case 1:
			buffer_y = (U8 *)pCIS->pCAMRegs->CICOYSA2;
			buffer_cb = (U8 *)pCIS->pCAMRegs->CICOCBSA2;
			buffer_cr = (U8 *)pCIS->pCAMRegs->CICOCRSA2;
			break;
		case 2:
			buffer_y = (U8 *)pCIS->pCAMRegs->CICOYSA3;
			buffer_cb = (U8 *)pCIS->pCAMRegs->CICOCBSA3;
			buffer_cr = (U8 *)pCIS->pCAMRegs->CICOCRSA3;
			break;
		case 3:
			buffer_y = (U8 *)pCIS->pCAMRegs->CICOYSA4;
			buffer_cb = (U8 *)pCIS->pCAMRegs->CICOCBSA4;
			buffer_cr = (U8 *)pCIS->pCAMRegs->CICOCRSA4;
			break;
		default :
			buffer_y = (U8 *)pCIS->pCAMRegs->CICOYSA1;
			buffer_cb = (U8 *)pCIS->pCAMRegs->CICOCBSA1;
			buffer_cr = (U8 *)pCIS->pCAMRegs->CICOCRSA1;
			break;
		}
	} 		

	buffer_y += VIRTUAL_ADDR_OFFSET;
	buffer_cb += VIRTUAL_ADDR_OFFSET;
	buffer_cr += VIRTUAL_ADDR_OFFSET;

	RETAILMSG(MSG_EN_1,(_T("buffer_y = 0x%x\r\n"), buffer_y));
	RETAILMSG(MSG_EN_1,(_T("buffer_cb = 0x%x\r\n"), buffer_cb));
	RETAILMSG(MSG_EN_1,(_T("buffer_cr = 0x%x\r\n"), buffer_cr));

	if (image_size == 1) // QCIF	
	{
		yuvinfo.frame_width = QCIF_XSIZE;
		yuvinfo.frame_height = QCIF_YSIZE;
	}
	else if (image_size == 2) // CIF	
	{
		yuvinfo.frame_width = CIF_XSIZE;
		yuvinfo.frame_height = CIF_YSIZE;
	}
	
	if (temp == frame_bank_prev) yuvinfo.frame_stamp = frame_timestamp_prev;
	else 
	{
		yuvinfo.frame_stamp = GetTickCount();
		frame_timestamp_prev = yuvinfo.frame_stamp;
		frame_bank_prev = temp;
	}

	RETAILMSG(MSG_EN_1,(_T("pBufOut 0 offset = 0x%x\r\n"), pImage));
	memcpy(pImage, &yuvinfo, sizeof(YUVINFO));
	pImage += sizeof(YUVINFO);	
	
	RETAILMSG(MSG_EN_1,(_T("pBufOut Y = 0x%x\r\n"), pImage));
	memcpy(pImage, buffer_y, Y_size);
	pImage += (Y_size);
	
	RETAILMSG(MSG_EN_1,(_T("pBufOut cb = 0x%x\r\n"), pImage));
	memcpy(pImage, buffer_cb, C_size);
	pImage += C_size;
	RETAILMSG(MSG_EN_1,(_T("pBufOut cr = 0x%x\r\n"), pImage));
	memcpy(pImage, buffer_cr, C_size);
//	pBufOut += (size_x*size_y)/4;




//	RETAILMSG(MSG_EN_1,(TEXT("1:buffer_y:0x%x,buffer_cb:0x%x,buffer_cr:0x%x\r\n"),buffer_y,buffer_cb,buffer_cr));

	//s2413IOP->GPFDAT |= (1<<6);	
	
	Tick_COPY_FRAME = GetTickCount();

	RETAILMSG(MSG_EN_1,(_T("COPY_Tick = %d\r\n"), (Tick_COPY_FRAME-Tick_GET_FRAME_CUR)));
	RETAILMSG(MSG_EN_1,(_T("Frame_Tick = %d\r\n"), (Tick_GET_FRAME_CUR-Tick_GET_FRAME_PREV)));
	
//	RETAILMSG(1,(_T("Tick_COPY_FRAME = %d\r\n"), Tick_COPY_FRAME));
//	RETAILMSG(1,(_T("Tick_GET_FRAME_PREV = %d\r\n"), Tick_GET_FRAME_PREV));
//	RETAILMSG(1,(_T("Tick_GET_FRAME_CUR = %d\r\n"), Tick_GET_FRAME_CUR));	


}

void Samsung_camcoder(U8 *pBufOut)
{
	U8 *pImage;
	PINGPONG caminfo;

	pImage = pBufOut;

	if( codec_flag )
	{
		caminfo.flag = 1;
		caminfo.y_address = y_address;
		caminfo.cb_address = cb_address;
		caminfo.cr_address = cr_address;
		
		memcpy(pImage, &caminfo, sizeof(PINGPONG));
		codec_flag = 0;
	}
}

void Samsung_camcoder_pr(U8 *pBufOut)
{
	U8 *pImage;
	PINGPONG_PR prinfo;

	pImage = pBufOut;

	if ( rgb_flag )
	{
		prinfo.flag = 1;
		prinfo.rgb_address = rgb_address;
		memcpy(pImage, &prinfo, sizeof(PINGPONG_PR));
		rgb_flag = 0;
	}	
}

void Buffer_codec_info_update()
{
	U32 Y_size, C_size, P_size;
	int temp;
	unsigned int buffer_y, buffer_cb, buffer_cr;
	
	if ( image_size == 1 )
		Y_size = QCIF_XSIZE*QCIF_YSIZE;
	else if ( image_size == 2 )
		Y_size = CIF_XSIZE*CIF_YSIZE;

	C_size = Y_size/4;	
	P_size = Y_size + C_size*2;

	temp = (pCIS->pCAMRegs->CICOSTATUS>>26)&3;
	temp = (temp + 2) % 4;

	RETAILMSG(MSG_EN_2,(_T("codec index = %d, size %d\r\n"), temp, image_size));

	switch (temp)
	{
	case 0:
		buffer_y = pCIS->pCAMRegs->CICOYSA1;
		buffer_cb = pCIS->pCAMRegs->CICOCBSA1;
		buffer_cr = pCIS->pCAMRegs->CICOCRSA1;
		break;
	case 1:
		buffer_y = pCIS->pCAMRegs->CICOYSA2;
		buffer_cb = pCIS->pCAMRegs->CICOCBSA2;
		buffer_cr = pCIS->pCAMRegs->CICOCRSA2;
		break;
	case 2:
		buffer_y = pCIS->pCAMRegs->CICOYSA3;
		buffer_cb = pCIS->pCAMRegs->CICOCBSA3;
		buffer_cr = pCIS->pCAMRegs->CICOCRSA3;
		break;
	case 3:
		buffer_y = pCIS->pCAMRegs->CICOYSA4;
		buffer_cb = pCIS->pCAMRegs->CICOCBSA4;
		buffer_cr = pCIS->pCAMRegs->CICOCRSA4;
		break;
	default :
		buffer_y = pCIS->pCAMRegs->CICOYSA1;
		buffer_cb = pCIS->pCAMRegs->CICOCBSA1;
		buffer_cr = pCIS->pCAMRegs->CICOCRSA1;
		break;
	}

	buffer_y += VIRTUAL_ADDR_OFFSET;
	buffer_cb += VIRTUAL_ADDR_OFFSET;
	buffer_cr += VIRTUAL_ADDR_OFFSET;
#if 0
	RETAILMSG(MSG_EN_1,(_T("buffer_y = 0x%x\r\n"), buffer_y));
	RETAILMSG(MSG_EN_1,(_T("buffer_cb = 0x%x\r\n"), buffer_cb));
	RETAILMSG(MSG_EN_1,(_T("buffer_cr = 0x%x\r\n"), buffer_cr));
#endif
	if( codec_flag )	RETAILMSG(MSG_EN_1,(_T("Buffer is not read\r\n")));
	codec_flag = 1;
	y_address = buffer_y;
	cb_address = buffer_cb;
	cr_address = buffer_cr;
}


void Buffer_preview_info_update()
{
//	U32 Y_size;
	int temp;
	unsigned int buffer_rgb;
	
/*
	if ( image_size == 1 )
		Y_size = QCIF_XSIZE*QCIF_YSIZE;
	else if ( image_size == 2 )
		Y_size = CIF_XSIZE*CIF_YSIZE;
*/

	temp = (pCIS->pCAMRegs->CICOSTATUS>>26)&3;
	temp = (temp + 2) % 4;

	RETAILMSG(MSG_EN_2,(_T("preview index = %d, size %d\r\n"), temp, image_size));

	switch (temp)
	{
	case 0:
		buffer_rgb = pCIS->pCAMRegs->CICOYSA1;
		break;
	case 1:
		buffer_rgb = pCIS->pCAMRegs->CICOYSA2;
		break;
	case 2:
		buffer_rgb = pCIS->pCAMRegs->CICOYSA3;
		break;
	case 3:
		buffer_rgb = pCIS->pCAMRegs->CICOYSA4;
		break;
	default :
		buffer_rgb = pCIS->pCAMRegs->CICOYSA1;
		break;
	}

	buffer_rgb += VIRTUAL_ADDR_OFFSET;
//	if( rgb_flag )	
//		RETAILMSG(MSG_EN_1,(_T("Buffer is not read\r\n")));
	rgb_flag = 1;
	rgb_address = buffer_rgb;
}


void CamInit(U32 CoDstWidth, U32 CoDstHeight, U32 WinHorOffset, U32 WinVerOffset,  U32 CoFrameBuffer)
{
	U32 WinOfsEn;
	U32 divisor, multiplier;
	U32 MainBurstSizeY, RemainedBurstSizeY, MainBurstSizeC, RemainedBurstSizeC, MainBurstSizeRGB, RemainedBurstSizeRGB;
	U32 H_Shift, V_Shift, PreHorRatio, PreVerRatio, MainHorRatio, MainVerRatio;
	U32 SrcWidth, SrcHeight;
	U32 ScaleUp_H_Co, ScaleUp_V_Co, ScaleUp_H_Pr, ScaleUp_V_Pr;

	//constant for calculating codec dma address

	if(CAM_CODEC_OUTPUT)
		divisor=2; //CCIR-422
	else
		divisor=4; //CCIR-420
		
	//constant for calculating preview dma address
// case 2440
/*	if(CAM_PVIEW_OUTPUT)
		multiplier=4;
	else
		multiplier=2;
*/

// case 2413
	if(CAM_PVIEW_OUTPUT == CAM_RGB24B)	// RGB24B
		multiplier=4;
	else	 if(CAM_PVIEW_OUTPUT == CAM_RGB16B)				// RGB16B
		multiplier=2;


	if(WinHorOffset==0 && WinVerOffset==0)
		WinOfsEn=0;
	else
		WinOfsEn=1;

	SrcWidth=CAM_SRC_HSIZE-WinHorOffset*2;
	SrcHeight=CAM_SRC_VSIZE-WinVerOffset*2;

	if(SrcWidth<=CoDstWidth) ScaleUp_H_Co=1; //down
	else ScaleUp_H_Co=0;		//up

	if(SrcHeight<=CoDstHeight) ScaleUp_V_Co=1;
	else ScaleUp_V_Co=0;		

// case 2440
/*	if(SrcWidth>=PrDstWidth) ScaleUp_H_Pr=0; //down
	else ScaleUp_H_Pr=1;		//up

	if(SrcHeight>=PrDstHeight) ScaleUp_V_Pr=0;
	else ScaleUp_V_Pr=1;		
*/
	////////////////// common control setting
	pCIS->pCAMRegs->CIGCTRL |= (0<<27)|(0<<26)|(1<<25); // inverse VSYNC, test pattern
	pCIS->pCAMRegs->CISRCFMT=(CAM_ITU601<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_CRYCBY<<14)|(CAM_SRC_VSIZE);
	pCIS->pCAMRegs->CIWDOFST=(WinOfsEn<<31)|(WinHorOffset<<16)|(WinVerOffset);
	pCIS->pCAMRegs->CIWDOFST2=(WinHorOffset<<16)|(WinVerOffset);

	RETAILMSG(1, (TEXT("CIGCTRL : %xh\n"), pCIS->pCAMRegs->CIGCTRL));
	
//	s2413CAM->CISRCFMT=(CAM_ITU601<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_YCBYCR<<14)|(CAM_SRC_VSIZE);
	//s2413CAM->CISRCFMT=(CAM_ITU656<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_CBYCRY<<14)|(CAM_SRC_VSIZE);

/*
#if ((CIS_TYPE == CIS_S5X532_Rev36) ||(CIS_TYPE == CIS_S5X3A1))
	pCIS->pCAMRegs->CISRCFMT=(CAM_ITU601<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_CRYCBY<<14)|(CAM_SRC_VSIZE);
#else
	//s2413CAM->CISRCFMT=(CAM_ITU601<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_YCBYCR<<14)|(CAM_SRC_VSIZE);
	pCIS->pCAMRegs->CISRCFMT=(CAM_ITU656<<31)|(0<<30)|(0<<29)|(CAM_SRC_HSIZE<<16)|(CAM_ORDER_CBYCRY<<14)|(CAM_SRC_VSIZE);
#endif
*/


	////////////////// codec port setting
/*	if(CAM_CODEC_PINGPONG) 
	{
		s2413CAM->CICOYSA1=CoFrameBuffer;
		s2413CAM->CICOYSA2=s2413CAM->CICOYSA1+CoDstWidth*CoDstHeight/multiplier;
		s2413CAM->CICOYSA3=s2413CAM->CICOYSA2+CoDstWidth*CoDstHeight/multiplier;
		s2413CAM->CICOYSA4=s2413CAM->CICOYSA3+CoDstWidth*CoDstHeight/multiplier;
	}
	else
	{
		s2413CAM->CICOYSA1=CoFrameBuffer;
		s2413CAM->CICOYSA2=s2413CAM->CICOYSA1;		
		s2413CAM->CICOYSA3=s2413CAM->CICOYSA1;
		s2413CAM->CICOYSA4=s2413CAM->CICOYSA1;		
	}
	
	s2413CAM->CICOTRGFMT=(CAM_CODEC_IN_422<<31)|(CAM_CODEC_OUTPUT<<30)|(CoDstWidth<<16)|(CAM_FLIP_NORMAL<<14)|(CoDstHeight);

	CalculateBurstSize(CoDstWidth, &MainBurstSizeY, &RemainedBurstSizeY);
	CalculateBurstSize(CoDstWidth/2, &MainBurstSizeC, &RemainedBurstSizeC);
	s2413CAM->CICOCTRL=(MainBurstSizeY<<19)|(RemainedBurstSizeY<<14)|(MainBurstSizeC<<9)|(RemainedBurstSizeC<<4);

	CalculatePrescalerRatioShift(SrcWidth, CoDstWidth, &PreHorRatio, &H_Shift);
	CalculatePrescalerRatioShift(SrcHeight, CoDstHeight, &PreVerRatio, &V_Shift);
	MainHorRatio=(SrcWidth<<8)/(CoDstWidth<<H_Shift);
	MainVerRatio=(SrcHeight<<8)/(CoDstHeight<<V_Shift);
    			
	s2413CAM->CICOSCPRERATIO=((10-H_Shift-V_Shift)<<28)|(PreHorRatio<<16)|(PreVerRatio);
	s2413CAM->CICOSCPREDST=((SrcWidth/PreHorRatio)<<16)|(SrcHeight/PreVerRatio); 
	s2413CAM->CICOSCCTRL=(CAM_SCALER_BYPASS_OFF<<31)|(ScaleUp_H_Co<<30)|(ScaleUp_V_Co<<29)|(MainHorRatio<<16)|(MainVerRatio);

	s2413CAM->CICOTAREA=CoDstWidth*CoDstHeight;
*/
	///////////////// preview port setting
	if(CAM_CODEC_PINGPONG) 
	{
		pCIS->pCAMRegs->CICOYSA1=CoFrameBuffer;
		pCIS->pCAMRegs->CICOYSA2=pCIS->pCAMRegs->CICOYSA1+CoDstWidth*CoDstHeight/multiplier;
		pCIS->pCAMRegs->CICOYSA3=pCIS->pCAMRegs->CICOYSA2+CoDstWidth*CoDstHeight/multiplier;
		pCIS->pCAMRegs->CICOYSA4=pCIS->pCAMRegs->CICOYSA3+CoDstWidth*CoDstHeight/multiplier;
	}
	else
	{
		pCIS->pCAMRegs->CICOYSA1=CoFrameBuffer;
		pCIS->pCAMRegs->CICOYSA2=pCIS->pCAMRegs->CICOYSA1;		
		pCIS->pCAMRegs->CICOYSA3=pCIS->pCAMRegs->CICOYSA1;
		pCIS->pCAMRegs->CICOYSA4=pCIS->pCAMRegs->CICOYSA1;		
	}

	if(CIS_TYPE == CIS_S5X3A1)
		pCIS->pCAMRegs->CICOTRGFMT=(1<<31)|(1<<30)|(1<<29)|(CoDstWidth<<16)|(CAM_FLIP_YAXIS<<14)|(CoDstHeight);
	else
		pCIS->pCAMRegs->CICOTRGFMT=(1<<31)|(1<<30)|(1<<29)|(CoDstWidth<<16)|(CAM_FLIP_NORMAL<<14)|(CoDstHeight);
	
	if (CAM_PVIEW_OUTPUT==CAM_RGB24B)
	{		
		CalculateBurstSize(CoDstWidth*4, &MainBurstSizeRGB, &RemainedBurstSizeRGB);
		CalculateBurstSize(CoDstWidth/2, &MainBurstSizeC, &RemainedBurstSizeC);
	}
	else // RGB16B
	{
		CalculateBurstSize(CoDstWidth, &MainBurstSizeY, &RemainedBurstSizeY);
		CalculateBurstSize(CoDstWidth/2, &MainBurstSizeC, &RemainedBurstSizeC);
	}
//   	s2413CAM->CIPRCTRL=(MainBurstSizeRGB<<19)|(RemainedBurstSizeRGB<<14);
	pCIS->pCAMRegs->CICOCTRL=(8<<19)|(4<<14)|(4<<9)|(2<<4);

	CalculatePrescalerRatioShift(SrcWidth, CoDstWidth, &PreHorRatio, &H_Shift);
	CalculatePrescalerRatioShift(SrcHeight, CoDstHeight, &PreVerRatio, &V_Shift);
	MainHorRatio=(SrcWidth<<8)/(CoDstWidth<<H_Shift);
	MainVerRatio=(SrcHeight<<8)/(CoDstHeight<<V_Shift);
	pCIS->pCAMRegs->CICOSCPRERATIO=((10-H_Shift-V_Shift)<<28)|(PreHorRatio<<16)|(PreVerRatio);		 
	pCIS->pCAMRegs->CICOSCPREDST=((SrcWidth/PreHorRatio)<<16)|(SrcHeight/PreVerRatio);
	pCIS->pCAMRegs->CICOSCCTRL=(CAM_SCALER_BYPASS_OFF<<31)|(ScaleUp_H_Co<<30)|(ScaleUp_V_Co<<29)|(MainHorRatio<<16)|(MainVerRatio);
    
	pCIS->pCAMRegs->CICOTAREA= CoDstWidth*CoDstHeight;

	pCIS->pCAMRegs->CIIMGCPT=(1<<26)|(0<<25)|(1<<24)|(0<<18);
	pCIS->pCAMRegs->CICOCPTSEQ=0xffffffff;
	pCIS->pCAMRegs->CICOSCOS=0x0;
	

	//clear overflow because unintentional overflow may be existed...
	pCIS->pCAMRegs->CIWDOFST|=(1<<30)|(0xf<<12);
	pCIS->pCAMRegs->CIWDOFST&=~((1<<30)|(0xf<<12));	

	// LJY, added 040615	
	// initialization for buffer addresses
// case 2440
/*	y_address = s2413CAM->CICOYSA1;
	cb_address = s2413CAM->CICOCBSA1;
	cr_address = s2413CAM->CICOCRSA1;
	rgb_address = s2413CAM->CIPRCLRSA1;
*/

}