/* sysfs input, to set the current videomode */ static ssize_t bmi_video_vmode_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t len) { struct bmi_video *video = dev_get_drvdata(dev); int err = 0; if (strstr(buf, "dvi") != NULL || strstr(buf, "DVI") != NULL){ err = scan_for_monitors(DVI, video); if(err) { printk(KERN_ERR "scan_for_monitors DVI err %d",err); return len; } enable_dvi(video); } else if (strstr(buf, "vga") != NULL || strstr(buf, "VGA") != NULL){ err = scan_for_monitors(VGA, video); if(err) { printk(KERN_ERR "scan_for_monitors VGA err %d",err); return len; } enable_vga(video); } else if (strstr(buf, "auto") != NULL || strstr(buf, "AUTO") != NULL){ err = scan_for_monitors(AUTO, video); if(err) { printk(KERN_ERR "scan_for_monitors err %d",err); return len; } if(video->dvi_monitor_edid) { //printk(KERN_INFO "dvi monitor detected"); enable_dvi(video); } else if(video->vga_monitor_edid) { //printk(KERN_INFO "vga monitor detected"); enable_vga(video); } else { printk(KERN_INFO "no monitor detected"); monitors_off(video); } } //test functions else if (strstr(buf, "t1") != NULL){ ths8200_reset(VGA_RESET_GPIO,video->vga_controller); tfp410_disable(video->dvi_controller); } else if (strstr(buf, "t2") != NULL){ ths8200_reset(VGA_RESET_GPIO,video->vga_controller); tfp410_enable(video->dvi_controller); } else if (strstr(buf, "t3") != NULL){ ths8200_enable(video->vga_controller); } else if (strstr(buf, "t4") != NULL){ ths8200_disable(video->vga_controller); } else if (strstr(buf, "t5") != NULL){ ths8200_init(video->vga_controller); } else if (strstr(buf, "off") != NULL || strstr(buf, "OFF") != NULL){ ths8200_reset(VGA_RESET_GPIO,video->vga_controller); tfp410_disable(video->dvi_controller); ths8200_disable(video->vga_controller); } return len; }
static void lcdc_io_init_component(unsigned char lcdc_num, unsigned char type) { unsigned int lcd_reg = 0; unsigned int width, height; stCOMPONENT_SPEC spec; stLTIMING ComponentTiming; stLCDCTR LcdCtrlParam; PVIOC_DISP pDISPBase; PVIOC_WMIX pWIXBase; PDDICONFIG pDDICfg = (PDDICONFIG)HwDDI_CONFIG_BASE; PNTSCPAL pTVE = (PNTSCPAL)HwNTSCPAL_BASE; PGPIO pGPIO = (PGPIO)HwGPIO_BASE; struct fbcon_config *fb_con; printf("%s, lcdc_num=%d, type=%d\n", __func__, lcdc_num, type); if(type >= LCDC_COMPONENT_MAX) type = defalut_component_resolution; #if defined(COMPONENT_CHIP_THS8200) #if defined(TARGET_BOARD_STB) /* THS8200 Power Control - GPIO_F16 */ gpio_set(TCC_GPF(16), 1); #else #endif #endif #ifndef DEFAULT_DISPLAY_OUTPUT_DUAL BITSET(pTVE->DACPD, HwTVEDACPD_PD_EN); #endif component_get_spec(type, &spec); LCDC_IO_Set(lcdc_num, spec.component_bus_width); fb_con = &fb_cfg; if(lcdc_num) { pDISPBase = (VIOC_DISP *)HwVIOC_DISP1; pWIXBase =(VIOC_WMIX *)HwVIOC_WMIX1; tca_ckc_setperi(PERI_LCD1, ENABLE, spec.component_clock*spec.component_divider); //VIOC_OUTCFG_SetOutConfig(VIOC_OUTCFG_MRGB, VIOC_OUTCFG_DISP1); } else { pDISPBase = (VIOC_DISP *)HwVIOC_DISP0; pWIXBase =(VIOC_WMIX *)HwVIOC_WMIX0; tca_ckc_setperi(PERI_LCD0, ENABLE, spec.component_clock*spec.component_divider); //VIOC_OUTCFG_SetOutConfig(VIOC_OUTCFG_MRGB, VIOC_OUTCFG_DISP0); } printf("LCDC0 clk:%d, LCDC1 clk:%d, PLL:%d, divide:%d\n", tca_ckc_getperi(PERI_LCD0), tca_ckc_getperi(PERI_LCD1), tca_ckc_getpll(PCDIRECTPLL0), spec.component_divider); width = spec.component_width; height = spec.component_height; lcdc_set_logo(lcdc_num, width, height, fb_con); ComponentTiming.lpw = spec.component_LPW; ComponentTiming.lpc = spec.component_LPC + 1; ComponentTiming.lswc = spec.component_LSWC + 1; ComponentTiming.lewc = spec.component_LEWC + 1; ComponentTiming.vdb = spec.component_VDB; ComponentTiming.vdf = spec.component_VDF; ComponentTiming.fpw = spec.component_FPW1; ComponentTiming.flc = spec.component_FLC1; ComponentTiming.fswc = spec.component_FSWC1; ComponentTiming.fewc = spec.component_FEWC1; ComponentTiming.fpw2 = spec.component_FPW2; ComponentTiming.flc2 = spec.component_FLC2; ComponentTiming.fswc2 = spec.component_FSWC2; ComponentTiming.fewc2 = spec.component_FEWC2; VIOC_DISP_SetTimingParam(pDISPBase, &ComponentTiming); memset(&LcdCtrlParam, NULL, sizeof(LcdCtrlParam)); switch(type) { case LCDC_COMPONENT_480I_NTSC: case LCDC_COMPONENT_576I_PAL: break; case LCDC_COMPONENT_720P: LcdCtrlParam.r2ymd = 3; LcdCtrlParam.ckg = 1; LcdCtrlParam.id= 0; LcdCtrlParam.iv = 1; LcdCtrlParam.ih = 1; LcdCtrlParam.ip = 0; LcdCtrlParam.pxdw = 12; LcdCtrlParam.ni = 1; break; case LCDC_COMPONENT_1080I: LcdCtrlParam.r2ymd = 3; LcdCtrlParam.ckg = 1; LcdCtrlParam.id= 1; LcdCtrlParam.iv = 1; LcdCtrlParam.ih = 0; LcdCtrlParam.ip = 1; LcdCtrlParam.pxdw = 12; LcdCtrlParam.ni = 0; LcdCtrlParam.tv = 1; break; default: break; } VIOC_DISP_SetControlConfigure(pDISPBase, &LcdCtrlParam); VIOC_DISP_SetSize(pDISPBase, width, height); VIOC_DISP_SetBGColor(pDISPBase, 0, 0 , 0); VIOC_WMIX_SetOverlayPriority(pWIXBase, 0); VIOC_WMIX_SetBGColor(pWIXBase, 0x00, 0x00, 0x00, 0xff); VIOC_WMIX_SetSize(pWIXBase, width, height); VIOC_WMIX_SetUpdate(pWIXBase); #if defined(TARGET_BOARD_STB) /* VE_FIELD: GPIO_E27 */ gpio_config(TCC_GPE(27), GPIO_FN0|GPIO_OUTPUT|GPIO_HIGH); #endif /* Enable Component Chip */ #if defined(COMPONENT_CHIP_CS4954) if(type == LCDC_COMPONENT_480I_NTSC) cs4954_enable(COMPONENT_MODE_NTSC_M); // NTSC_M else cs4954_enable(COMPONENT_MODE_PAL_B); // PAL_B #elif defined(COMPONENT_CHIP_THS8200) if(type == LCDC_COMPONENT_720P) ths8200_enable(COMPONENT_MODE_720P); // 720P else ths8200_enable(COMPONENT_MODE_1080I); // 1080I #endif VIOC_DISP_TurnOn(pDISPBase); }