/* * 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; }