DPI_STATUS DPI_Capture_Framebuffer(unsigned int pvbuf, unsigned int bpp)
{
#if 0
unsigned int i = 0;
unsigned char *fbv;
unsigned int fbsize = 0;
unsigned int dpi_fb_bpp = 0;
unsigned int w,h;
BOOL dpi_needPowerOff = FALSE;
if(!s_isDpiPowerOn){
DPI_PowerOn();
dpi_needPowerOff = TRUE;
LCD_WaitForNotBusy();
LCD_WaitDPIIndication(FALSE);
LCD_FBReset();
LCD_StartTransfer(TRUE);
LCD_WaitDPIIndication(TRUE);
}
if(pvbuf == 0 || bpp == 0)
{
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "DPI_Capture_Framebuffer, ERROR, parameters wrong: pvbuf=0x%08x, bpp=%d\n", pvbuf, bpp);
return DPI_STATUS_OK;
}
if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB565)
{
dpi_fb_bpp = 16;
}
else if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB888)
{
dpi_fb_bpp = 24;
}
else
{
DISP_LOG_PRINT(ANDROID_LOG_ERROR, "DPI", "DPI_Capture_Framebuffer, ERROR, dpi_fb_bpp is wrong: %d\n", dpi_fb_bpp);
return DPI_STATUS_OK;
}
w = DISP_GetScreenWidth();
h = DISP_GetScreenHeight();
fbsize = w*h*dpi_fb_bpp/8;
if(dpi_needPowerOff)
fbv = (unsigned char*)ioremap_cached((unsigned int)DPI_REG->FB[0].ADDR, fbsize);
else
fbv = (unsigned char*)ioremap_cached((unsigned int)DPI_REG->FB[DPI_GetCurrentFB()].ADDR, fbsize);
DISP_LOG_PRINT(ANDROID_LOG_INFO, "DPI", "current fb count is %d\n", DPI_GetCurrentFB());
if(bpp == 32 && dpi_fb_bpp == 24)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
*(unsigned int*)(pvbuf+ (pix_count - i) * 4) = 0xff000000|fbv[i*3]|(fbv[i*3+1]<<8)|(fbv[i*3+2]<<16);
}
}
else{
for(i = 0;i < w*h; i++)
{
*(unsigned int*)(pvbuf+i*4) = 0xff000000|fbv[i*3]|(fbv[i*3+1]<<8)|(fbv[i*3+2]<<16);
}
}
}
else if(bpp == 32 && dpi_fb_bpp == 16)
{
unsigned int t;
unsigned short* fbvt = (unsigned short*)fbv;
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
t = fbvt[i];
*(unsigned int*)(pvbuf+ (pix_count - i) * 4) = 0xff000000|((t&0x001F)<<3)|((t&0x07E0)<<5)|((t&0xF800)<<8);
}
}
else{
for(i = 0;i < w*h; i++)
{
t = fbvt[i];
*(unsigned int*)(pvbuf+i*4) = 0xff000000|((t&0x001F)<<3)|((t&0x07E0)<<5)|((t&0xF800)<<8);
}
}
}
else if(bpp == 16 && dpi_fb_bpp == 16)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
unsigned short* fbvt = (unsigned short*)fbv;
for(i = 0;i < w*h; i++)
{
*(unsigned short*)(pvbuf+ (pix_count - i) * 2) = fbvt[i];
}
}
else
memcpy((void*)pvbuf, (void*)fbv, fbsize);
}
else if(bpp == 16 && dpi_fb_bpp == 24)
{
if(0 == strncmp(MTK_LCM_PHYSICAL_ROTATION, "180", 3)){
unsigned int pix_count = w * h - 1;
for(i = 0;i < w*h; i++)
{
*(unsigned short*)(pvbuf+ (pix_count - i) * 2) = ((fbv[i*3+0]&0xF8)>>3)|
((fbv[i*3+1]&0xFC)<<3)|
((fbv[i*3+2]&0xF8)<<8);
}
}
else{
for(i = 0;i < w*h; i++)
DPI_STATUS DPI_Capture_Framebuffer(unsigned int pvbuf, unsigned int bpp)
{
unsigned int i = 0;
unsigned char *fbv;
unsigned int fbsize = 0;
unsigned int dpi_fb_bpp = 0;
unsigned int w,h;
if(s_isDpiPowerOn == false)
{
DPI_PowerOn();
}
if(pvbuf == 0 || bpp == 0)
{
printk("DPI_Capture_Framebuffer, ERROR, parameters wrong: pvbuf=0x%08x, bpp=%d\n", pvbuf, bpp);
return DPI_STATUS_OK;
}
if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB565)
{
dpi_fb_bpp = 16;
}
else if(DPI_FBGetFormat() == DPI_FB_FORMAT_RGB888)
{
dpi_fb_bpp = 24;
}
else
{
printk("DPI_Capture_Framebuffer, ERROR, dpi_fb_bpp is wrong: %d\n", dpi_fb_bpp);
return DPI_STATUS_OK;
}
w = DISP_GetScreenWidth();
h = DISP_GetScreenHeight();
fbsize = w*h*dpi_fb_bpp/8;
fbv = (unsigned char*)ioremap_cached((unsigned int)DPI_REG->FB[DPI_GetCurrentFB()].ADDR, fbsize);
printk("current fb count is %d\n", DPI_GetCurrentFB());
if(bpp == 32 && dpi_fb_bpp == 24)
{
for(i = 0;i < w*h; i++)
{
*(unsigned int*)(pvbuf+i*4) = 0xff000000|fbv[i*3]|(fbv[i*3+1]<<8)|(fbv[i*3+2]<<16);
}
}
else if(bpp == 32 && dpi_fb_bpp == 16)
{
unsigned int t;
unsigned short* fbvt = (unsigned short*)fbv;
for(i = 0;i < w*h; i++)
{
t = fbvt[i];
*(unsigned int*)(pvbuf+i*4) = 0xff000000|((t&0x001F)<<3)|((t&0x07E0)<<5)|((t&0xF800)<<8);
}
}
else if(bpp == 16 && dpi_fb_bpp == 16)
{
memcpy((void*)pvbuf, (void*)fbv, fbsize);
}
else if(bpp == 16 && dpi_fb_bpp == 24)
{
for(i = 0;i < w*h; i++)
{
*(unsigned short*)(pvbuf+i*2) = ((fbv[i*3+0]&0x1F)>>3)|
((fbv[i*3+1]&0xFC)<<3)|
((fbv[i*3+2]&0x1F)<<8);
}
}
else
{
