/*
* todo
*/
static int Fb_set_par(struct fb_info *info)
{
__u32 sel = 0;
__inf("Fb_set_par: %dx%d %dbits\n", info->var.xres, info->var.yres,
info->var.bits_per_pixel);
for (sel = 0; sel < 2; sel++) {
if (((sel == 0) &&
(g_fbi.fb_mode[info->node] != FB_MODE_SCREEN1)) ||
((sel == 1) &&
(g_fbi.fb_mode[info->node] != FB_MODE_SCREEN0))) {
struct fb_var_screeninfo *var = &info->var;
struct fb_fix_screeninfo *fix = &info->fix;
__s32 layer_hdl = g_fbi.layer_hdl[info->node][sel];
__disp_layer_info_t layer_para;
__u32 buffer_num = 1;
__u32 y_offset = 0;
if (g_fbi.fb_mode[info->node] ==
FB_MODE_DUAL_SAME_SCREEN_TB)
buffer_num = 2;
if ((sel == 0) && (g_fbi.fb_mode[info->node] ==
FB_MODE_DUAL_SAME_SCREEN_TB))
y_offset = var->yres / 2;
BSP_disp_layer_get_para(sel, layer_hdl, &layer_para);
var_to_disp_fb(&(layer_para.fb), var, fix);
layer_para.src_win.x = var->xoffset;
layer_para.src_win.y = var->yoffset + y_offset;
layer_para.src_win.width = var->xres;
layer_para.src_win.height = var->yres / buffer_num;
if (layer_para.mode != DISP_LAYER_WORK_MODE_SCALER) {
layer_para.scn_win.width =
layer_para.src_win.width;
layer_para.scn_win.height =
layer_para.src_win.height;
}
BSP_disp_layer_set_para(sel, layer_hdl, &layer_para);
}
}
return 0;
}
__s32 Display_Fb_Request(__u32 fb_id, __disp_fb_create_para_t *fb_para)
{
struct fb_info *info = NULL;
__s32 hdl = 0;
__disp_layer_info_t layer_para;
__u32 sel;
__u32 xres, yres;
unsigned long ulLCM;
__u32 num_screens;
num_screens = bsp_disp_feat_get_num_screens();
__inf("Display_Fb_Request,fb_id:%d\n", fb_id);
if(g_fbi.fb_enable[fb_id]) {
__wrn("Display_Fb_Request, fb%d is already requested!\n", fb_id);
return DIS_NO_RES;
}
info = g_fbi.fbinfo[fb_id];
xres = fb_para->width;
yres = fb_para->height;
if((0 == xres) || (0 == yres)) {
__wrn("invalid paras xres(%d, yres(%d) in Display_Fb_Request\n", xres, yres);
return DIS_FAIL;
}
info->var.xoffset = 0;
info->var.yoffset = 0;
info->var.xres = xres;
info->var.yres = yres;
info->var.xres_virtual = xres;
info->fix.line_length = (fb_para->width * info->var.bits_per_pixel) >> 3;
ulLCM = LCM(info->fix.line_length, PAGE_SIZE);
info->fix.smem_len = RoundUpToMultiple(info->fix.line_length * fb_para->height, ulLCM) * fb_para->buffer_num;
info->var.yres_virtual = info->fix.smem_len / info->fix.line_length;
Fb_map_video_memory(info);
for(sel = 0; sel < num_screens; sel++) {
if(((sel==0) && (fb_para->fb_mode != FB_MODE_SCREEN1))
|| ((sel==1) && (fb_para->fb_mode != FB_MODE_SCREEN0))) {
__u32 y_offset = 0, src_width = xres, src_height = yres;
if(((sel==0) && (fb_para->fb_mode == FB_MODE_SCREEN0 || fb_para->fb_mode == FB_MODE_DUAL_SAME_SCREEN_TB))
|| ((sel==1) && (fb_para->fb_mode == FB_MODE_SCREEN1))
|| ((sel == fb_para->primary_screen_id) && (fb_para->fb_mode == FB_MODE_DUAL_DIFF_SCREEN_SAME_CONTENTS))) {
__disp_tcon_timing_t tt;
if(bsp_disp_get_timming(sel, &tt) >= 0) {
info->var.pixclock = 1000000000 / tt.pixel_clk;
info->var.left_margin = tt.hor_back_porch;
info->var.right_margin = tt.hor_front_porch;
info->var.upper_margin = tt.ver_back_porch;
info->var.lower_margin = tt.ver_front_porch;
info->var.hsync_len = tt.hor_sync_time;
info->var.vsync_len = tt.ver_sync_time;
}
info->var.width = bsp_disp_get_screen_physical_width(sel);
info->var.height = bsp_disp_get_screen_physical_height(sel);
}
if(fb_para->fb_mode == FB_MODE_DUAL_SAME_SCREEN_TB) {
src_height = yres/ 2;
if(sel == 0) {
y_offset = yres / 2;
}
}
memset(&layer_para, 0, sizeof(__disp_layer_info_t));
layer_para.mode = fb_para->mode;
layer_para.scn_win.width = src_width;
layer_para.scn_win.height = src_height;
if(fb_para->fb_mode == FB_MODE_DUAL_DIFF_SCREEN_SAME_CONTENTS) {
if(sel != fb_para->primary_screen_id) {
layer_para.mode = DISP_LAYER_WORK_MODE_SCALER;
layer_para.scn_win.width = fb_para->aux_output_width;
layer_para.scn_win.height = fb_para->aux_output_height;
} else if(fb_para->mode == DISP_LAYER_WORK_MODE_SCALER) {
layer_para.scn_win.width = fb_para->output_width;
layer_para.scn_win.height = fb_para->output_height;
}
} else if(fb_para->mode == DISP_LAYER_WORK_MODE_SCALER) {
layer_para.scn_win.width = fb_para->output_width;
layer_para.scn_win.height = fb_para->output_height;
}
hdl = bsp_disp_layer_request(sel, layer_para.mode);
if(hdl == 0) {
__wrn("Display_Fb_Request, ch%d no layer resource\n", sel);
Fb_unmap_video_memory(info);
return DIS_NO_RES;
}
layer_para.pipe = 0;
layer_para.alpha_en = 1;
layer_para.alpha_val = 0xff;
layer_para.ck_enable = 0;
layer_para.src_win.x = 0;
layer_para.src_win.y = y_offset;
layer_para.src_win.width = src_width;
layer_para.src_win.height = src_height;
layer_para.scn_win.x = 0;
layer_para.scn_win.y = 0;
var_to_disp_fb(&(layer_para.fb), &(info->var), &(info->fix));
layer_para.fb.addr[0] = (__u32)info->fix.smem_start;
layer_para.fb.addr[1] = 0;
layer_para.fb.addr[2] = 0;
layer_para.fb.size.width = fb_para->width;
layer_para.fb.size.height = fb_para->height;
layer_para.fb.cs_mode = DISP_BT601;
layer_para.b_from_screen = 0;
bsp_disp_layer_set_para(sel, hdl, &layer_para);
bsp_disp_layer_open(sel, hdl);
g_fbi.layer_hdl[fb_id][sel] = hdl;
}
}
g_fbi.fb_enable[fb_id] = 1;
g_fbi.fb_mode[fb_id] = fb_para->fb_mode;
memcpy(&g_fbi.fb_para[fb_id], fb_para, sizeof(__disp_fb_create_para_t));
return DIS_SUCCESS;
}
__s32 Display_Fb_Request(__u32 fb_id, __disp_fb_create_para_t * fb_para)
{
struct fb_info *info = NULL;
__s32 hdl = 0;
__disp_layer_info_t layer_para;
__u32 sel;
__u32 xres, yres;
__inf("Display_Fb_Request,fb_id:%d\n", fb_id);
info = g_fbi.fbinfo[fb_id];
xres = fb_para->width;
yres = fb_para->height;
info->var.xoffset = 0;
info->var.yoffset = 0;
info->var.xres = xres;
info->var.yres = yres;
info->var.xres_virtual = xres;
info->var.yres_virtual = yres * fb_para->buffer_num;
info->fix.line_length =
(fb_para->width * info->var.bits_per_pixel) >> 3;
info->fix.smem_len =
info->fix.line_length * fb_para->height * fb_para->buffer_num;
Fb_map_video_memory(info);
for (sel = 0; sel < 2; sel++) {
if (((sel == 0) && (fb_para->fb_mode != FB_MODE_SCREEN1)) ||
((sel == 1) && (fb_para->fb_mode != FB_MODE_SCREEN0))) {
__u32 y_offset = 0, src_width = xres, src_height = yres;
if (((sel == 0) &&
(fb_para->fb_mode == FB_MODE_SCREEN0 ||
fb_para->fb_mode ==
FB_MODE_DUAL_SAME_SCREEN_TB)) ||
((sel == 1) &&
(fb_para->fb_mode == FB_MODE_SCREEN1)) ||
((sel == fb_para->primary_screen_id) &&
(fb_para->fb_mode ==
FB_MODE_DUAL_DIFF_SCREEN_SAME_CONTENTS))) {
__disp_tcon_timing_t tt;
if (BSP_disp_get_timing(sel, &tt) >= 0) {
info->var.pixclock =
1000000000 / tt.pixel_clk;
info->var.left_margin =
tt.hor_back_porch;
info->var.right_margin =
tt.hor_front_porch;
info->var.upper_margin =
tt.ver_back_porch;
info->var.lower_margin =
tt.ver_front_porch;
info->var.hsync_len = tt.hor_sync_time;
info->var.vsync_len = tt.ver_sync_time;
}
}
if (fb_para->fb_mode == FB_MODE_DUAL_SAME_SCREEN_TB) {
src_height = yres / 2;
if (sel == 0)
y_offset = yres / 2;
}
memset(&layer_para, 0, sizeof(__disp_layer_info_t));
layer_para.mode = fb_para->mode;
layer_para.scn_win.width = src_width;
layer_para.scn_win.height = src_height;
if (fb_para->fb_mode ==
FB_MODE_DUAL_DIFF_SCREEN_SAME_CONTENTS) {
if (sel != fb_para->primary_screen_id) {
layer_para.mode =
DISP_LAYER_WORK_MODE_SCALER;
layer_para.scn_win.width =
fb_para->aux_output_width;
layer_para.scn_win.height =
fb_para->aux_output_height;
} else if (fb_para->mode ==
DISP_LAYER_WORK_MODE_SCALER) {
layer_para.scn_win.width =
fb_para->output_width;
layer_para.scn_win.height =
fb_para->output_height;
}
} else if (fb_para->mode ==
DISP_LAYER_WORK_MODE_SCALER) {
layer_para.scn_win.width =
fb_para->output_width;
layer_para.scn_win.height =
fb_para->output_height;
}
hdl = BSP_disp_layer_request(sel, layer_para.mode);
layer_para.pipe = 0;
layer_para.alpha_en = 1;
layer_para.alpha_val = 0xff;
layer_para.ck_enable = 0;
layer_para.src_win.x = 0;
layer_para.src_win.y = y_offset;
layer_para.src_win.width = src_width;
layer_para.src_win.height = src_height;
layer_para.scn_win.x = 0;
layer_para.scn_win.y = 0;
var_to_disp_fb(&(layer_para.fb), &(info->var),
&(info->fix));
layer_para.fb.addr[0] = (__u32) info->fix.smem_start;
layer_para.fb.addr[1] = 0;
layer_para.fb.addr[2] = 0;
layer_para.fb.size.width = fb_para->width;
layer_para.fb.size.height = fb_para->height;
layer_para.fb.cs_mode = DISP_BT601;
layer_para.b_from_screen = 0;
BSP_disp_layer_set_para(sel, hdl, &layer_para);
BSP_disp_layer_open(sel, hdl);
g_fbi.layer_hdl[fb_id][sel] = hdl;
}
}
g_fbi.fb_enable[fb_id] = 1;
g_fbi.fb_mode[fb_id] = fb_para->fb_mode;
memcpy(&g_fbi.fb_para[fb_id], fb_para, sizeof(__disp_fb_create_para_t));
return DIS_SUCCESS;
}
