add win0 support

This commit is contained in:
钟勇汪
2010-05-19 08:54:13 +00:00
committed by 黄涛
parent acf1c122bc
commit 24bc41b343
2 changed files with 306 additions and 85 deletions

View File

@@ -60,7 +60,9 @@
#define WIN1_USE_DOUBLE_BUF 1 //win1 use double buf to accelerate display
#define LANDSCAPE_USE_ROTATE 1 //rotate win1 in landscape with mcu panel
#if 0
#define CURSOR_BUF_SIZE 256 //RK2818 cursor need 256B buf
#if 1
#define fbprintk(msg...) printk(msg);
#else
#define fbprintk(msg...)
@@ -72,14 +74,7 @@
#else
#define fbprintk2(msg...)
#endif
/*
#define LcdReadBit(inf, addr, msk) ((inf->regbak.addr=__raw_readl(inf->preg->addr))&(msk))
#define LcdWrReg(inf, addr, val) __raw_writel(val, inf->regbak.addr); inf->preg->addr = (val)
#define LcdRdReg(inf, addr) __raw_readl(inf->preg->addr)
#define LcdSetBit(inf, addr, msk) __raw_writel((inf->regbak.addr |= (msk)), inf->preg->addr)
#define LcdClrBit(inf, addr, msk) __raw_writel((inf->regbak.addr &= ~(msk)), inf->preg->addr)
#define LcdMskReg(inf, addr, msk, val) (inf->regbak.addr)&=~(msk); __raw_writel((inf->regbak.addr|=(val)), inf->preg->addr)
*/
#define LcdReadBit(inf, addr, msk) ((inf->regbak.addr=inf->preg->addr)&(msk))
#define LcdWrReg(inf, addr, val) inf->preg->addr=inf->regbak.addr=(val)
#define LcdRdReg(inf, addr) (inf->preg->addr)
@@ -165,6 +160,7 @@ struct rk2818fb_inf {
struct clk *dclk; //lcdc dclk
struct clk *dclk_parent; //lcdc dclk divider frequency source
struct clk *dclk_divider; //lcdc demodulator divider frequency
struct clk *clk_share_mem; //lcdc share memory frequency
unsigned long dclk_rate;
/* lcdc reg base address and backup reg */
@@ -190,6 +186,10 @@ struct rk2818fb_inf {
__u32 smem_len2;
unsigned long smem_start2;
char __iomem *cursor_base; /* cursor Virtual address*/
__u32 cursor_size; /* Amount of ioremapped VRAM or 0 */
unsigned long cursor_start;
struct rk28fb_screen lcd_info;
struct rk28fb_screen tv_info[5];
struct rk28fb_screen hdmi_info[2];
@@ -355,11 +355,7 @@ void mcutimer_callback(unsigned long arg)
switch(inf->mcu_status)
{
case MS_IDLE:
if(OUT_P16BPP4==inf->cur_screen->face) {
inf->mcu_status = MS_EBOOK;
} else {
inf->mcu_status = MS_MCU;
}
inf->mcu_status = MS_MCU;
break;
case MS_MCU:
if(inf->mcu_usetimer) mcu_do_refresh(inf);
@@ -406,16 +402,16 @@ int mcu_refresh(struct rk2818fb_inf *inf)
if(SCREEN_MCU!=inf->cur_screen->type) return 0;
if(!mcutimer_inited) {
if(!mcutimer_inited)
{
mcutimer_inited = 1;
init_timer(&inf->mcutimer);
inf->mcutimer.function = mcutimer_callback;
inf->mcutimer.expires = jiffies + HZ/5;
inf->mcu_status = 0;
inf->mcu_status = MS_IDLE;
add_timer(&inf->mcutimer);
}
inf->mcu_ebooknew = 1;
if(MS_MCU==inf->mcu_status) mcu_do_refresh(inf);
return 0;
@@ -497,7 +493,7 @@ void load_screen(struct fb_info *info, bool initscreen)
struct rk2818fb_inf *inf = dev_get_drvdata(info->device);
struct rk28fb_screen *screen = inf->cur_screen;
u16 face = screen->face;
u16 mcu_total, mcu_rwstart, mcu_csstart, mcu_rwend, mcu_csend;
u16 right_margin = screen->right_margin, lower_margin = screen->lower_margin;
u16 x_res = screen->x_res, y_res = screen->y_res;
u32 clk_rate = 0;
@@ -505,9 +501,31 @@ void load_screen(struct fb_info *info, bool initscreen)
fbprintk(">>>>>> %s : %s \n", __FILE__, __FUNCTION__);
// if(OUT_P16BPP4==face) face = OUT_P565;
// set the rgb or mcu
LcdMskReg(inf, MCU_TIMING_CTRL, m_MCU_OUTPUT_SELECT, v_MCU_OUTPUT_SELECT((SCREEN_MCU==screen->type)?(1):(0)));
// set out format and mcu timing
mcu_total = (screen->mcu_wrperiod*150*1000)/1000000;
if(mcu_total>31) mcu_total = 31;
if(mcu_total<3) mcu_total = 3;
mcu_rwstart = (mcu_total+1)/4 - 1;
mcu_rwend = ((mcu_total+1)*3)/4 - 1;
mcu_csstart = (mcu_rwstart>2) ? (mcu_rwstart-3) : (0);
mcu_csend = (mcu_rwend>15) ? (mcu_rwend-1) : (mcu_rwend);
fbprintk(">> mcu_total=%d, mcu_rwstart=%d, mcu_csstart=%d, mcu_rwend=%d, mcu_csend=%d \n",
mcu_total, mcu_rwstart, mcu_csstart, mcu_rwend, mcu_csend);
LcdMskReg(inf, MCU_TIMING_CTRL,
m_MCU_CS_ST | m_MCU_CS_END| m_MCU_RW_ST | m_MCU_RW_END |
m_MCU_WRITE_PERIOD | m_MCU_HOLDMODE_SELECT | m_MCU_HOLDMODE_FRAME_ST,
v_MCU_CS_ST(mcu_csstart) | v_MCU_CS_END(mcu_csend) | v_MCU_RW_ST(mcu_rwstart) |
v_MCU_RW_END(mcu_rwend) | v_MCU_WRITE_PERIOD(mcu_total) |
v_MCU_HOLDMODE_SELECT((SCREEN_MCU==screen->type)?(1):(0)) | v_MCU_HOLDMODE_FRAME_ST(0)
);
// set synchronous pin polarity and data pin swap rule
LcdMskReg(inf, DSP_CTRL0,
m_DISPLAY_FORMAT | m_HSYNC_POLARITY | m_VSYNC_POLARITY | m_DEN_POLARITY |
@@ -516,7 +534,7 @@ void load_screen(struct fb_info *info, bool initscreen)
v_DEN_POLARITY(screen->pin_den) | v_DCLK_POLARITY(screen->pin_dclk) | v_COLOR_SPACE_CONVERSION(0)
);
LcdMskReg(inf, DSP_CTRL1, m_BG_COLOR, v_BG_COLOR(0xff0000) );
LcdMskReg(inf, DSP_CTRL1, m_BG_COLOR, v_BG_COLOR(0x000000) );
LcdMskReg(inf, SWAP_CTRL, m_OUTPUT_RB_SWAP | m_OUTPUT_RG_SWAP | m_DELTA_SWAP | m_DUMMY_SWAP,
v_OUTPUT_RB_SWAP(screen->swap_rb) | v_OUTPUT_RG_SWAP(screen->swap_rg) | v_DELTA_SWAP(screen->swap_delta) | v_DUMMY_SWAP(screen->swap_dumy));
@@ -561,7 +579,7 @@ void load_screen(struct fb_info *info, bool initscreen)
dclk_rate = screen->pixclock * 1000000;
printk(">>>>>> set lcdc dclk need %d HZ, clk_parent = %d hz \n ", screen->pixclock, clk_rate);
fbprintk(">>>>>> set lcdc dclk need %d HZ, clk_parent = %d hz \n ", screen->pixclock, clk_rate);
if(clk_rate < dclk_rate)
{
@@ -590,7 +608,7 @@ void load_screen(struct fb_info *info, bool initscreen)
}
clk_enable(inf->dclk);
// clk_enable(inf->clk);
clk_enable(inf->clk);
// init screen panel
if(screen->init && initscreen)
@@ -630,6 +648,114 @@ static int fb_setcolreg(unsigned regno,
return 0;
}
int rk2818_set_cursor(struct fb_info *info, struct fb_cursor *cursor)
{
struct rk2818fb_inf *inf = dev_get_drvdata(info->device);
fbprintk(">>>>>> %s : %s \n", __FILE__, __FUNCTION__);
/* check not being asked to exceed capabilities */
if (cursor->image.width > 32)
return -EINVAL;
if (cursor->image.height > 32)
return -EINVAL;
if (cursor->image.depth > 1)
return -EINVAL;
if (cursor->enable)
LcdSetBit(inf, SYS_CONFIG, m_HWC_ENABLE);
else
LcdClrBit(inf, SYS_CONFIG, m_HWC_ENABLE);
/* set data */
if (cursor->set & FB_CUR_SETPOS)
{
unsigned int x = cursor->image.dx;
unsigned int y = cursor->image.dy;
if (x >= 0x800 || y >= 0x800 )
return -EINVAL;
LcdWrReg(inf, HWC_DSP_ST, v_BIT11LO(x)|v_BIT11HI(y));
}
if (cursor->set & FB_CUR_SETCMAP)
{
unsigned int bg_col = cursor->image.bg_color;
unsigned int fg_col = cursor->image.fg_color;
fbprintk("%s: update cmap (%08x,%08x)\n",
__func__, bg_col, fg_col);
LcdMskReg(inf, HWC_COLOR_LUT0, m_HWC_R|m_HWC_G|m_HWC_B,
v_HWC_R(info->cmap.red[bg_col]) | v_HWC_G(info->cmap.green[bg_col]) | v_HWC_B(info->cmap.blue[bg_col]));
LcdMskReg(inf, HWC_COLOR_LUT2, m_HWC_R|m_HWC_G|m_HWC_B,
v_HWC_R(info->cmap.red[fg_col]) | v_HWC_G(info->cmap.green[fg_col]) | v_HWC_B(info->cmap.blue[fg_col]));
}
if (cursor->set & FB_CUR_SETSIZE ||
cursor->set & (FB_CUR_SETIMAGE | FB_CUR_SETSHAPE))
{
/* rk2818 cursor is a 2 bpp 32x32 bitmap this routine
* clears it to transparent then combines the cursor
* shape plane with the colour plane to set the
* cursor */
int x, y;
const unsigned char *pcol = cursor->image.data;
const unsigned char *pmsk = cursor->mask;
void __iomem *dst;
unsigned long cursor_mem_start;
unsigned char dcol = 0;
unsigned char dmsk = 0;
unsigned int op;
dst = info->screen_base + info->fix.smem_len - CURSOR_BUF_SIZE;
cursor_mem_start = info->fix.smem_start + info->fix.smem_len - CURSOR_BUF_SIZE;
fbprintk("%s: setting shape (%d,%d)\n",
__func__, cursor->image.width, cursor->image.height);
memset(dst, 0, CURSOR_BUF_SIZE);
for (y = 0; y < cursor->image.height; y++)
{
for (x = 0; x < cursor->image.width; x++)
{
if ((x % 8) == 0) {
dcol = *pcol++;
dmsk = *pmsk++;
} else {
dcol >>= 1;
dmsk >>= 1;
}
if (dmsk & 1) {
op = (dcol & 1) ? 1 : 3;
op <<= ((x % 4) * 2);
*(u8*)(dst+(x/4)) |= op;
}
}
dst += (32*2)/8;
}
LcdSetBit(inf, SYS_CONFIG,m_HWC_RELOAD_EN);
LcdWrReg(inf, HWC_MST, cursor_mem_start);
// flush end when wq_condition=1 in mcu panel, but not in rgb panel
if(SCREEN_MCU == inf->cur_screen->type) {
wait_event_interruptible_timeout(wq, wq_condition, HZ/20);
wq_condition = 0;
} else {
wq_condition = 0;
wait_event_interruptible_timeout(wq, wq_condition, HZ/20);
}
LcdSetBit(inf, SYS_CONFIG, m_HWC_RELOAD_EN);
}
return 0;
}
static int win0fb_blank(int blank_mode, struct fb_info *info)
{
struct rk2818fb_inf *inf = dev_get_drvdata(info->device);
@@ -670,7 +796,8 @@ static int win0fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
u16 ysize = (var->grayscale>>20) & 0xfff;
u16 xlcd = screen->x_res; //size of panel
u16 ylcd = screen->y_res;
u16 yres = 0;
if(IsMcuLandscape())
{
xlcd = screen->y_res;
@@ -758,10 +885,18 @@ static int win0fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
return -EINVAL;
}
ScaleYDnY = CalScaleDownW0(var->yres, ysize);
ScaleYUpY = CalScaleUpW0(var->yres, ysize);
if(var->rotate == 270)
{
yres = var->xres;
}
else
{
yres = var->yres;
}
ScaleYDnY = CalScaleDownW0(yres, ysize);
ScaleYUpY = CalScaleUpW0(yres, ysize);
if((ScaleYDnY>0x8000) || (ScaleYUpY<=0x200))
if((ScaleYDnY>0x8000) || (ScaleYUpY<0x200))
{
return -EINVAL; // multiple of scale down or scale up can't exceed 8
}
@@ -772,6 +907,7 @@ static int win0fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
static int win0fb_set_par(struct fb_info *info)
{
struct rk2818fb_inf *inf = dev_get_drvdata(info->device);
struct rk28fb_screen *screen = inf->cur_screen;
struct fb_var_screeninfo *var = &info->var;
struct fb_fix_screeninfo *fix = &info->fix;
struct win0_par *par = info->par;
@@ -779,7 +915,6 @@ static int win0fb_set_par(struct fb_info *info)
u8 format = 0;
dma_addr_t map_dma;
u32 y_offset=0, uv_offset=0, cblen=0, crlen=0, map_size=0, smem_len=0;
u16 xres=var->xres;
u16 xpos = (var->nonstd>>8) & 0xfff;
u16 ypos = (var->nonstd>>20) & 0xfff;
u16 xsize = (var->grayscale>>8) & 0xfff;
@@ -787,6 +922,8 @@ static int win0fb_set_par(struct fb_info *info)
u32 win0_en = var->reserved[2];
u32 y_addr = var->reserved[3];
u32 uv_addr = var->reserved[4];
u32 actWidth = 0;
u32 actHeight = 0;
u32 ScaleYUpX=0x1000, ScaleYDnX=0x1000, ScaleYUpY=0x1000, ScaleYDnY=0x1000;
u32 ScaleCbrUpX=0x1000, ScaleCbrDnX=0x1000, ScaleCbrUpY=0x1000, ScaleCbrDnY=0x1000;
@@ -820,6 +957,11 @@ static int win0fb_set_par(struct fb_info *info)
fix->line_length = var->xres_virtual;
y_offset = var->yoffset*var->xres_virtual + var->xoffset;
uv_offset = var->yoffset*var->xres_virtual + var->xoffset;
if(var->rotate == 270)
{
y_offset += var->xres_virtual*(var->yres - 1);
uv_offset += var->xres_virtual*(var->yres - 1);
}
cblen = crlen = (var->xres_virtual*var->yres_virtual)/2;
break;
case 2: // yuv4200
@@ -827,6 +969,11 @@ static int win0fb_set_par(struct fb_info *info)
fix->line_length = var->xres_virtual;
y_offset = var->yoffset*var->xres_virtual + var->xoffset;
uv_offset = (var->yoffset/2)*var->xres_virtual + var->xoffset;
if(var->rotate == 270)
{
y_offset += var->xres_virtual*(var->yres - 1);
uv_offset += var->xres_virtual*(var->yres/2 - 1);
}
cblen = crlen = (var->xres_virtual*var->yres_virtual)/4;
break;
case 3: // yuv4201
@@ -834,6 +981,11 @@ static int win0fb_set_par(struct fb_info *info)
fix->line_length = var->xres_virtual;
y_offset = (var->yoffset/2)*2*var->xres_virtual + (var->xoffset)*2;
uv_offset = (var->yoffset/2)*var->xres_virtual + var->xoffset;
if(var->rotate == 270)
{
y_offset += var->xres_virtual*2*(var->yres/2 - 1);
uv_offset += var->xres_virtual*(var->yres/2 - 1);
}
cblen = crlen = (var->xres_virtual*var->yres_virtual)/4;
break;
case 4: // yuv420m
@@ -910,90 +1062,99 @@ static int win0fb_set_par(struct fb_info *info)
fbprintk("y_addr 0x%08x = 0x%08x + %d\n", y_addr, (u32)fix->smem_start, y_offset);
fbprintk("uv_addr 0x%08x = 0x%08x + %d\n", uv_addr, (u32)fix->mmio_start , uv_offset);
if(var->rotate == 270)
{
actWidth = var->yres;
actHeight = var->xres;
}
else
{
actWidth = var->xres;
actHeight = var->yres;
}
if((var->xres>1280) && (xsize>1280))
{
ScaleYDnX = CalScaleDownW0(var->xres, 1280);
ScaleYDnX = CalScaleDownW0(actWidth, 1280);
ScaleYUpX = CalScaleUpW0(1280, xsize);
}
else
{
ScaleYDnX = CalScaleDownW0(var->xres, xsize);
ScaleYUpX = CalScaleUpW0(var->xres, xsize);
ScaleYDnX = CalScaleDownW0(actWidth, xsize);
ScaleYUpX = CalScaleUpW0(actWidth, xsize);
}
ScaleYDnY = CalScaleDownW0(var->yres, ysize);
ScaleYUpY = CalScaleUpW0(var->yres, ysize);
ScaleYDnY = CalScaleDownW0(actHeight, ysize);
ScaleYUpY = CalScaleUpW0(actHeight, ysize);
switch(var->nonstd&0xff)
{
case 0: // rgb
{
case 1:// yuv422
if((var->xres>1280) && (xsize>1280))
{
ScaleCbrDnX= CalScaleDownW0((var->xres/2), 1280);
ScaleCbrDnX= CalScaleDownW0((actWidth/2), 1280);
ScaleCbrUpX = CalScaleUpW0((640), xsize);
}
else
{
if(var->rotate)
if(var->rotate == 270)
{
ScaleCbrDnX= CalScaleDownW0(var->xres, xsize);
ScaleCbrUpX = CalScaleUpW0(var->xres, xsize);
ScaleCbrDnX= CalScaleDownW0(actWidth, xsize);
ScaleCbrUpX = CalScaleUpW0(actWidth, xsize);
}
else
{
ScaleCbrDnX= CalScaleDownW0((var->xres/2), xsize);
ScaleCbrUpX = CalScaleUpW0((var->xres/2), xsize);
ScaleCbrDnX= CalScaleDownW0((actWidth/2), xsize);
ScaleCbrUpX = CalScaleUpW0((actWidth/2), xsize);
}
}
ScaleCbrDnY = CalScaleDownW0(var->yres, ysize);
ScaleCbrUpY = CalScaleUpW0(var->yres, ysize);
ScaleCbrDnY = CalScaleDownW0(actHeight, ysize);
ScaleCbrUpY = CalScaleUpW0(actHeight, ysize);
break;
case 2: // yuv4200
case 3: // yuv4201
case 4: // yuv420m
if((var->xres>1280) && (xsize>1280))
{
ScaleCbrDnX= CalScaleDownW0(var->xres/2, 1280);
ScaleCbrDnX= CalScaleDownW0(actWidth/2, 1280);
ScaleCbrUpX = CalScaleUpW0(640, xsize);
}
else
{
ScaleCbrDnX= CalScaleDownW0(var->xres/2, xsize);
ScaleCbrUpX = CalScaleUpW0(var->xres/2, xsize);
ScaleCbrDnX= CalScaleDownW0(actWidth/2, xsize);
ScaleCbrUpX = CalScaleUpW0(actWidth/2, xsize);
}
ScaleCbrDnY = CalScaleDownW0(var->yres/2, ysize);
ScaleCbrUpY = CalScaleUpW0(var->yres/2, ysize);
ScaleCbrDnY = CalScaleDownW0(actHeight/2, ysize);
ScaleCbrUpY = CalScaleUpW0(actHeight/2, ysize);
break;
case 5:// yuv444
if((var->xres>1280) && (xsize>1280))
{
ScaleCbrDnX= CalScaleDownW0(var->xres, 1280);
ScaleCbrDnX= CalScaleDownW0(actWidth, 1280);
ScaleCbrUpX = CalScaleUpW0(1280, xsize);
}
else
{
ScaleCbrDnX= CalScaleDownW0(var->xres, xsize);
ScaleCbrUpX = CalScaleUpW0(var->xres, xsize);
ScaleCbrDnX= CalScaleDownW0(actWidth, xsize);
ScaleCbrUpX = CalScaleUpW0(actWidth, xsize);
}
ScaleCbrDnY = CalScaleDownW0(var->yres, ysize);
ScaleCbrUpY = CalScaleUpW0(var->yres, ysize);
ScaleCbrDnY = CalScaleDownW0(actHeight, ysize);
ScaleCbrUpY = CalScaleUpW0(actHeight, ysize);
break;
}
xpos += LcdReadBit(inf, DSP_HACT_ST_END, m_BIT11HI);
ypos += LcdReadBit(inf, DSP_VACT_ST_END, m_BIT11HI);
xpos += (screen->left_margin + screen->hsync_len);
ypos += (screen->upper_margin + screen->vsync_len);
LcdWrReg(inf, WIN0_YRGB_MST, y_addr);
LcdWrReg(inf, WIN0_CBR_MST, uv_addr);
LcdMskReg(inf, SYS_CONFIG, m_W0_ENABLE | m_W0_FORMAT,
v_W0_ENABLE(win0_en) | v_W0_FORMAT(format));
LcdMskReg(inf, SYS_CONFIG, m_W0_ENABLE | m_W0_FORMAT | m_W0_ROTATE,
v_W0_ENABLE(win0_en) | v_W0_FORMAT(format) | v_W0_ROTATE(var->rotate==270));
LcdMskReg(inf, WIN0_VIR, m_WORDLO | m_WORDHI, v_VIRWIDTH(var->xres_virtual) | v_VIRHEIGHT((var->yres_virtual)) );
LcdMskReg(inf, WIN0_ACT_INFO, m_WORDLO | m_WORDHI, v_WORDLO(xres) | v_WORDHI(var->yres));
LcdMskReg(inf, WIN0_ACT_INFO, m_WORDLO | m_WORDHI, v_WORDLO(actWidth) | v_WORDHI(actHeight));
LcdMskReg(inf, WIN0_DSP_ST, m_BIT11LO | m_BIT11HI, v_BIT11LO(xpos) | v_BIT11HI(ypos));
LcdMskReg(inf, WIN0_DSP_INFO, m_BIT11LO | m_BIT11HI, v_BIT11LO(xsize) | v_BIT11HI(ysize));
LcdMskReg(inf, WIN0_SD_FACTOR_Y, m_WORDLO | m_WORDHI, v_WORDLO(ScaleYDnX) | v_WORDHI(ScaleYDnY));
@@ -1105,6 +1266,37 @@ static int win0fb_pan_display(struct fb_var_screeninfo *var, struct fb_info *inf
return 0;
}
/* Set rotation (0, 90, 180, 270 degree), and switch to the new mode. */
int win0fb_rotate(struct fb_info *fbi, int rotate)
{
struct fb_var_screeninfo *var = &fbi->var;
u32 SrcFmt = var->nonstd&0xff;
if(rotate == 0)
{
if(var->rotate)
{
var->rotate = 0;
if(!win0fb_check_var(var, fbi))
win0fb_set_par(fbi);
}
}
else
{
if((var->xres >1280) || (var->yres >720)||((SrcFmt!= 1) && (SrcFmt!= 2) && (SrcFmt!= 3)))
{
return -EPERM;
}
if(var->rotate != 270)
{
var->rotate = 270;
if(!win0fb_check_var(var, fbi))
win0fb_set_par(fbi);
}
}
return 0;
}
int win0fb_open(struct fb_info *info, int user)
{
struct win0_par *par = info->par;
@@ -1243,6 +1435,18 @@ static int win0fb_ioctl(struct fb_info *info, unsigned int cmd, unsigned long ar
}
}
break;
case FB1_IOCTL_SET_ROTATE:
fbprintk(">>>>>> change lcdc direction(%d) \n", (int)arg);
switch(arg)
{
case 0:
win0fb_rotate(info, 0);
break;
case 270:
win0fb_rotate(info, 270);
break;
}
break;
default:
break;
}
@@ -1304,6 +1508,8 @@ static int win1fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
u16 ylcd = screen->y_res;
u8 trspmode = (var->grayscale>>8) & 0xff;
u8 trspval = (var->grayscale) & 0xff;
//u16 xsize = var->xres;//(var->grayscale>>8) & 0xfff; //visiable size in panel
u16 ysize = var->yres;//(var->grayscale>>20) & 0xfff;
fbprintk(">>>>>> %s : %s\n", __FILE__, __FUNCTION__);
@@ -1350,7 +1556,7 @@ static int win1fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
break;
}
// ScaleY = CalScaleW1(var->yres, ysize);
ScaleY = CalScaleW1(var->yres, ysize);
if((ScaleY>0x8000) ||(ScaleY<0x200))
{
@@ -1370,13 +1576,20 @@ static int win1fb_set_par(struct fb_info *info)
u8 format = 0;
dma_addr_t map_dma;
u32 offset=0, addr=0, map_size=0, smem_len=0;
u16 xpos = (var->nonstd>>8) & 0xfff;
u32 ScaleX = 0x1000;
u32 ScaleY = 0x1000;
u16 xres_virtual = var->xres_virtual; //virtual screen size
// u16 yres_virtual = var->yres_virtual;
u16 xsize_virtual = var->xres; //visiable size in virtual screen
u16 ysize_virtual = var->yres;
// u16 xpos_virtual = var->xoffset; //visiable offset in virtual screen
// u16 ypos_virtual = var->yoffset;
u16 xpos = (var->nonstd>>8) & 0xfff; //visiable offset in panel
u16 ypos = (var->nonstd>>20) & 0xfff;
u16 xres = var->xres, yres = var->yres, xres_virtual = var->xres_virtual;
// u8 trspmode = TRSP_FMREG; //(var->grayscale>>8) & 0xff;
// u8 trspmode = TRSP_CLOSE; // <20><>ʹ<EFBFBD><CAB9>Ӳ<EFBFBD><D3B2><EFBFBD>İ<EFBFBD>͸<EFBFBD><CDB8><EFBFBD><EFBFBD>.
u8 trspmode = TRSP_CLOSE; // <20><>ָ<EFBFBD><D6B8><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD> value (ȱʡ<C8B1><CAA1> <20><>ɫ(0, 0, 0) ), <20><><EFBFBD><EFBFBD>Ϊ ȫ͸.
u8 trspval = 1; //(var->grayscale) & 0xff;
u16 xsize = var->xres;//(var->grayscale>>8) & 0xfff; //visiable size in panel
u16 ysize = var->yres;//(var->grayscale>>20) & 0xfff;
//the below code is not correct, make we can't see alpha picture.
//u8 trspmode = (var->grayscale>>8) & 0xff;
@@ -1401,7 +1614,7 @@ static int win1fb_set_par(struct fb_info *info)
break;
}
smem_len = fix->line_length * var->yres_virtual;
smem_len = fix->line_length * var->yres_virtual + CURSOR_BUF_SIZE; //cursor buf also alloc here
map_size = PAGE_ALIGN(smem_len);
#if WIN1_USE_DOUBLE_BUF
@@ -1448,8 +1661,8 @@ static int win1fb_set_par(struct fb_info *info)
addr = fix->smem_start + offset;
if(TRSP_FMREGEX==trspmode) trspmode = TRSP_FMREG;
if(TRSP_FMRAMEX==trspmode) trspmode = TRSP_FMRAM;
ScaleX = CalScaleW1(xsize_virtual, xsize);
ScaleY = CalScaleW1(ysize_virtual, ysize);
LcdMskReg(inf, SYS_CONFIG, m_W1_ENABLE|m_W1_FORMAT, v_W1_ENABLE(1)|v_W1_FORMAT(format));
@@ -1460,14 +1673,18 @@ static int win1fb_set_par(struct fb_info *info)
LcdWrReg(inf, WIN1_VIR_MST, fix->smem_start);
LcdMskReg(inf, WIN1_DSP_ST, m_BIT11LO|m_BIT11HI, v_BIT11LO(xpos) | v_BIT11HI(ypos));
LcdMskReg(inf, WIN1_DSP_INFO, m_BIT11LO|m_BIT11HI, v_BIT11LO(xres) | v_BIT11HI(yres));
LcdMskReg(inf, WIN1_DSP_INFO, m_BIT11LO|m_BIT11HI, v_BIT11LO(xsize) | v_BIT11HI(ysize));
LcdMskReg(inf, WIN1_VIR, m_WORDLO | m_WORDHI , v_WORDLO(xres_virtual) | v_WORDHI(var->yres_virtual));
LcdMskReg(inf, WIN1_ACT_INFO, m_WORDLO | m_WORDHI, v_WORDLO(xres) | v_WORDHI(yres));
LcdMskReg(inf, WIN1_ACT_INFO, m_WORDLO | m_WORDHI, v_WORDLO(xsize_virtual) | v_WORDHI(ysize_virtual));
LcdMskReg(inf, BLEND_CTRL, m_W1_BLEND_EN | m_W1_BLEND_FACTOR_SELECT | m_W1_BLEND_FACTOR,
v_W1_BLEND_EN((TRSP_FMREG==trspmode) || (TRSP_MASK==trspmode)) |
v_W1_BLEND_FACTOR_SELECT(TRSP_FMRAM==trspmode) | v_W1_BLEND_FACTOR(trspval)); //͸<><CDB8><EFBFBD><EFBFBD>
LcdMskReg(inf, WIN1_SCL_FACTOR, m_HSCALE_FACTOR | m_VSCALE_FACTOR, v_HSCALE_FACTOR(ScaleX) | v_VSCALE_FACTOR(ScaleY));
// LcdMskReg(inf, BLEND_CTRL, m_W1_BLEND_EN | m_W1_BLEND_FACTOR_SELECT | m_W1_BLEND_FACTOR,
// v_W1_BLEND_EN((TRSP_FMREG==trspmode) || (TRSP_MASK==trspmode)) |
// v_W1_BLEND_FACTOR_SELECT(TRSP_FMRAM==trspmode) | v_W1_BLEND_FACTOR(trspval));
LcdMskReg(inf, WIN1_COLOR_KEY_CTRL, m_COLORKEY_EN | m_KEYCOLOR, v_COLORKEY_EN(1) | v_KEYCOLOR(0)); //open color key and set the color to 0
if(1==format) //rgb565
{
@@ -1610,7 +1827,7 @@ static struct fb_ops win1fb_ops = {
.fb_fillrect = cfb_fillrect,
.fb_copyarea = cfb_copyarea,
.fb_imageblit = cfb_imageblit,
.fb_cursor = NULL,//fb_set_cursor,
//.fb_cursor = rk2818_set_cursor,
};
@@ -2021,8 +2238,6 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
goto unregister_win1fb;
}
clk_enable(inf->clk );
inf->dclk = clk_get(&pdev->dev, "lcdc");
if (!inf->dclk || IS_ERR(inf->dclk))
{
@@ -2045,7 +2260,15 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
goto unregister_win1fb;
}
printk("got and enabled clock\n");
inf->clk_share_mem= clk_get(&pdev->dev, "lcdc_share_memory");
if (!inf->clk_share_mem || IS_ERR(inf->clk_share_mem))
{
dev_err(&pdev->dev, "failed to get lcd clock clk_share_mem source \n");
ret = -ENOENT;
goto unregister_win1fb;
}
fbprintk("got clock\n");
mach_info = pdev->dev.platform_data;
if(mach_info)
@@ -2072,7 +2295,7 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
load_screen(inf->win1fb, 1);
/* Register framebuffer(win1fb & win0fb) */
fbprintk(">> Register framebuffer(win1fb & win0fb) \n");
fbprintk(">> Register framebuffer(win1fb) \n");
ret = register_framebuffer(inf->win1fb);
if(ret<0)
{
@@ -2080,8 +2303,10 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
ret = -EINVAL;
goto release_win0fb;
}
fbprintk(">> Register framebuffer(win0fb) \n");
// ret = register_framebuffer(inf->win0fb);
ret = register_framebuffer(inf->win0fb);
if(ret<0)
{
printk(">> win0fb register_framebuffer fail!\n");
@@ -2102,7 +2327,7 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
if (irq < 0) {
dev_err(&pdev->dev, "no irq for device\n");
ret = -ENOENT;
goto release_irq;
goto unregister_win1fb;
}
ret = request_irq(irq, rk2818fb_irq, IRQF_DISABLED, pdev->name, pdev);
if (ret) {
@@ -2123,11 +2348,6 @@ static int __init rk2818fb_probe (struct platform_device *pdev)
}
}
#if (0==FMK_USE_HARDTIMER)
hrtimer_init(&inf->htimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
inf->htimer.function = rk2818_fb_dohtimer;
#endif
return ret;
release_irq:
@@ -2380,13 +2600,13 @@ static struct platform_driver rk2818fb_driver = {
static int __init rk2818fb_init(void)
{
fbprintk(">>>>>> %s : %s\n", __FILE__, __FUNCTION__);
printk(">>>>>> %s : %s\n", __FILE__, __FUNCTION__);
return platform_driver_register(&rk2818fb_driver);
}
static void __exit rk2818fb_exit(void)
{
fbprintk(">>>>>> %s : %s\n", __FILE__, __FUNCTION__);
printk(">>>>>> %s : %s\n", __FILE__, __FUNCTION__);
platform_driver_unregister(&rk2818fb_driver);
}

View File

@@ -344,6 +344,7 @@
#define FB1_IOCTL_GET_PANEL_SIZE 0x5001
#define FB1_IOCTL_SET_YUV_ADDR 0x5002
#define FB1_TOCTL_SET_MCU_DIR 0x5003
#define FB1_IOCTL_SET_ROTATE 0x5004
/********************************************************************